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Preface 


The  goal  of  this  study  was  to  gain  some  insight  into  the  propagation 
of  errors  through  a  strapdown  inertial  reference  system  as  a  result  of 
highly  dynamic  flight  profiles.  This  was  to  be  done  using  modern  estimation 
theory  and  stochastic  models  of  state-of-the-art  sensors.  Since  a  simu¬ 
lation  package  was  not  available  to  achieve  this  objective,  a  generalized 
simulation  program,  SOFE,  was  used  as  a  basis  to  develop  the  desired 
software  package. 

A  large  portion  of  this  thesis  was  directed  toward  implementing 
and  validating  the  software  required  to  perform  the  error  analysis.  It 
is  my  belief  that  credible  results  can  be  achieved  only  when  painstaking 
effort  is  used  in  setting  up  the  problem. 

I  would  like  to  thank  my  thesis  advisor,  Dr  Peter  S.  Maybeck,  for 
his  enthusiastic  help  throughout  this  study.  Also,  the  well  docunented 

software  and  generous  assistance  provided  by  Stanton  H.  Musick  of  the 

\ 

Air  Force  Avionics  Laboratory  was  of  great  benefit  and  made  this  task 

\ 

considerably  easier.  Finally,  I  sincerely  thank  my  wife,  Elaine,  for 
her  excellent  typing  and  patient  endurance. 
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Abstract 


''  \ 

Thi s  study  uses  a  computer  simulation  of  a  strapdown  laser  gyro 
inertial  reference  system  to  analyze  the  errors  generated  as  a  result 
of  highly  dynamic  -flight  profiles.  A  stochastic  error  model  using  state- 
of-the-art  inertial .sensors  is  developed  in  detail  and  implemented  in 
software.  SOFE,  a  generalized  simulation  program,  was  used  to  implement 
both  a  Monte  Carlo  simulation  and  a  covariance  analysis.  The  Monte  Carlo 
method  was  selected  to  perform  the  error  analysis. 

Two  highly  dynamic  flight  trajectories  were  developed  using  the 
flight  profile  generator,  PROFGEN.  The  PROFGEN  program  itself  was  modified 

to  include  an  aircraft  roll  time  constant  and  a  roll -only  maneuver.  The 

\ 

errors  generated  in  the  Inertial  reference  system  as  a  result  of  these 
flight  trajectories  were  investigated.  Both  an  error  budget  and  an  analysis 
of  the  maneuvers  inducing  these  errors  were  accomplished. 

Gyro  error  sources  induced  the  most  system  error  and  coupled  the 
dynamics  of  the  flight  trajectory  into  the  variations  of  the  error.  Misa¬ 
lignment  was  found  to  be  the  major  cause  of  both  the  accelerometer  and 
gyro  induced  error.  Successive  maneuvers  were  found  that  reinforced 
system  errors  and  other  maneuvers  were  found  that  cancelled  these  errors. 
Also,  some  cases  were  found  where  the  amount  of  system  error  varied  with 
a  change  in  heading 
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SENSITIVITY  STUDY  OF  STRAPDOWN  INERTIAL 


SENSORS  IN  HIGH  PERFORMANCE  APPLICATIONS 


I.  Introduction 


Background 

Strapdown  inertial  reference  systems  eliminate  many  of  the  mechan¬ 
ical  complexities  of  gimbaled  systems  since  they  have  fewer  moving  parts. 
This  leads  to  smaller  components,  improved  reliability,  easier  mainten¬ 
ance,  and  less  cost.  But,  these  systems  also  have  some  disadvantages. 

In  a  strapdown  system  the  gyros  and  accelerometers  are  mounted 

(through  vibration  dampers)  directly  to  the  airframe.  The  gyros  supply 

angular  velocity  directly  to  the  navigation  computer.  The  computer.  In 
% 

turn,  uses  the  angular  Information  to  resolve  the  direction  of  the  sensed 
acceleration.  This  additional  computation  Is  not  present  in  a  gimbaled 
system,  since  these  systems  use  the  gyros  directly  to  maintain  the  accel¬ 
erometers  In  a  known  orientation.  However,  Increased  computational  re¬ 
quirements  are  no  longer  a  serious  drawback  considering  the  current 
availability  of  low  cost  minicomputers. 

A  factor  of  greater  concern  In  a  strapdown  reference  system  is 
that  the  inertial  sensors  are  subjected  to  a  more  dynamic  environment 
than  sensors  in  a  gimbaled  system.  This  is  especially  true  in  high  per¬ 
formance  fighter  aircraft.  The  gyros  and  accelerometers  are  subjected 
to  both  the  faster  dynamics  of  aircraft  attitude  changes  and  motion  over 
a  wider  dynamic  range:  not  only  must  they  withstand  a  harsher  enviro- 
ment,  they  must  provide  precise  outputs  over  vastly  differing  regimes. 


The  development  of  the  ring  laser  gyro  has  enhanced  Interest  In 
strapdown  inertial  reference  systems.  This  type  of  gyro  measures  rota¬ 
tion  by  detecting  differences  in  the  frequency  of  light  travelling  in 
opposite  directions  within  a  rotating  cavity  and  is  essentially  a  solid 
state  device  (Ref  1).  Since  it  has  no  moving  parts,  it  is  not  suscep¬ 
tible  to  acceleration-induced  errors  and  is  well  suited  to  the  highly 
dynamic  enviroment  of  a  strapdown  system.  Its  mechanical  simplicity 
also  makes  it  adaptable  to  mass  production  techniques  which  can  lead  to 
lower  acquisition  costs. 

Problem 

Present  strapdown  ring  laser  gyro  strapdown  reference  systems  pro¬ 
vide  acceptable  accuracy  In  the  relatively  benign  environment  of  trans¬ 
port  or  commercial  aircraft.  However,  these  systems  do  not  provide  the 
desired  accuracy  when  used  In  a  highly  dynamic  environment  such  as  that 
of  a  modern  air  superiority  fighter  aircraft. 

One  of  the  first  steps  in  refining  the  accuracy  of  a  strapdown 
system  is  to  develop  a  full  understanding  of  the  propagation  of  sensor 
errors  through  the  system.  The  problem  undertaken  in  this  study  will 
be  to  develop  a  computer  simulation  of  a  state-of-the-art  strapdown 
inertial  reference  system  followed  by  an  analysis  of  the  impact  of 
Individual  sensor  errors  upon  overall  system  errors.  Highly  dynamic 
flight  profiles  will  be  used  to  generate  the  inertial  reference  system 
errors. 

A  deterministic  analysis  of  the  effects  of  sensor  errors  on  strap- 
down  inertial  reference  system  performance  was  accomplished  In  a  pre¬ 
vious  thesis  by  Lt  Richard  H.  Reynolds  (Ref  14).  Although  this  deter¬ 
ministic  approach  provides  valuable  baseline  information,  it  does  not 
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accurately  portray  the  uncertainties  in  the  system  model,  nor  does  It 
account  for  uncertain  initial  conditions  and  noise-corrupted  inputs. 

The  probabilistic  approach  undertaken  here  utilizes  stochastic 
models  to  account  for  uncertainties  in  the  inertial  reference  system. 
Stochastic  process  and  modern  estimation  theories  will  also  be  used  to 
characterize  the  Initial  conditions,  forcing  functions,  and  the  result¬ 
ing  system  outputs. 

Scope 

The  focus  of  this  study  will  be  to  identify  the  relative  effect 
of  each  error  source  on  the  overall  system  error.  Also,  the  severity 
of  errors  induced  by  specific  flight  profiles  will  be  investigated  so 
that  maneuvers  that  degrade  performance  can  be  identified. 

Error  models  characterizing  the  dominant  sources  of  errors  of 
state-of-the-art  inertial  sensors  will  be  used  in  the  simulation.  The 
Bell  Model  XI  accelerometer  (Ref  5)  was  chosen  for  this  application  be¬ 
cause  of  its  wide  use  in  current  high-accuracy  Inertial  reference  sys¬ 
tems,  while  the  Honeywell  GG1342  ring  laser  gyro  was  chosen  because  it 
is  currently  available  and  has  been  flight  tested  in  the  A-7E  using 
highly  dynamic  flight  profiles. 

Flight  profiles  will  be  generated  based  upon  the  performance  char¬ 
acteristics  of  an  FI 5  aircraft.  In  its  air  superiority  role,  the  F15 
represents  the  most  dynamic  environment  that  an  aircraft  Inertial  sys¬ 
tem  currently  encounters. 

Devel opment 

The  initial  portion  of  this  study  entails  the  development  of  the 
software  and  models  to  perform  the  error  analysis.  First,  a  set  of 
error  differential  equations  for  a  ring  laser  gyro  strapdown  inertial 
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reference  system  will  be  developed  based  upon  the  general  formulation 
used  by  Widnall  and  Grundy  (Ref  17).  These  equations  will  then  be 
implemented  in  a  digital  simulation  program  called  SOFE  (Ref  12).  SOFE 
will  be  used  to  generate  statistics  by  the  methods  of  Monte  Carlo  simula¬ 
tion  and  also  by  covariance  propagation  for  the  linearized  error  equa¬ 
tion  model  of  the  strap-down  inertial  reference  system. 

In  addition,  two  supporting  computer  programs,  a  flight  profile 
generator,  PROFGEN  (Ref  11),  and  a  post  processor  for  generating  sample 
statistics  and  plots,  SOFEPL  (Ref  6),  will  be  used  in  conjunction  with 
the  basic  simulation  program. 

Validation  of  the  implementation  of  the  basic  error  differential 
equations  will  be  accomplished  by  duplicating  error  standard  deviation 
plots  shown  In  Reference  17  for  a  simpler  model.  Further  validation  of 
the  complete  augmented  state  equations  will  be  accomplished  by  comparing 
the  results  of  the  two  different  approaches,  the  Monte  Carlo  simulation 
and  the  covariance  analysis. 

Representative  F15  flight  profiles  will  then  be  developed,  followed 
by  an  analysis  of  the  errors  generated  in  the  strapdown  system  as  a  re¬ 
sult  of  the  highly  dynamic  profiles.  In  addition  to  determining  the 
error  budget  for  each  flight  profile,  the  sources  of  system  error  induced 
by  specific  high  dynamic  maneuvers  will  be  sought. 


II.  Error  Model  DevelODment 


Basic  Error  Differential  Equations 

In  order  to  analyze  the  performance  of  a  reference  system  using 
modern  linear  estimation  theory,  a  stochastic  system  error  model  is 
often  expressed  in  the  form  of  linearized  first  order  differential 
equations.  These  equations  are  of  the  form 

=  F  +  Bu.  +  w  ( 1 ) 


where 


F  =  Fundamental  Matrix 
B  =  Control  Input  Matrix 
x  =  Error  State  Vector 
u  =  Deterministic  Forcing  Function 
w  =  White  Gaussian  Driving  Noise 

Britting  showed  that  the  same  basic  equations  could  be  used  for 
both  gimbaled  and  strapdown  systems  (Ref  4).  These  consist  of  a 
system-independent  nlne-by-nine  matrix  Pinson  error  model  (Ref  13) 
augmented  by  system-dependent  error  forcing  functions.  The  first  three 
states  represent  errors  in  position,  states  four  through  six  are  veloc¬ 
ity  errors,  and  states  seven  through  nine  are  tilt  errors.  These  states 
are  defined  in  Table  1.  The  nine-by-nine  matrix  for  the  Pinson  model 
is  shown  in  Figure  1  with  corresponding  notation  shown  In  Table  2. 
Widnall  and  Grundy  developed  first  order  error  equations  for  a  strap- 
down  reference  system  In  this  fashion  (Ref  17),  so  many  of  their  results 
will  be  applied  in  the  development  of  the  model  used  here. 
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Meaning 


Units 


Error  in  east  longitude 

radians 

Error  in  north  latitude 

radians 

Error  in  altitude 

feet 

Error  in  east  velocity 

ft/sec 

Error  in  north  velocity 

ft/sec 

Error  in  vertical  velocity 

ft/sec 

Attitude  error  east  component 

radians 

Attitude  error  north  component 

radians 

Attitude  error  up  component 

radians 

1.  States  of  the  Nine  Dimensional  Pinson  Error  Model 


Symbol  and  Value 


Meaning 


n  =  7 . 292 11 5 1 xl 0-5  rad/sec 
R  =  20925640  ft 
g  =  32.0881576 


j  ve  *  vn*  vu 

|V  Fn*  fu 
Qn  s  ncosL 

nu  =  nsinL 

pu  '  'Vn/R 

pn*  »e/R 
°u  '  (vetanL)/R 

“e  3  pe 

“n  =  pn  * 

“u  =  pu  *  nu 
Kz  =  vu/R 


F42  ’  2*Vn  +  Vu  ' 


*  pnVcos  L 

f43  =  pupe  *  pnK2 
=  -pgtanL  -  Kz 

f52  =  -2f!nve  '  p„Vcos!l 
F53  *  pn°u  '  peKz 
F63  *  29'«  '  tp„2  *  pe2> 
F92  *  “n  *  puta"L 


Latitude 

Earth  Rotation  Rate 
Radius  of  Earth 
Magnitude  of  gravity  vector 
Vel.  in  local  nav  frame  (e,n,u) 
Specific  Force  in  nav  frame 
North  Component  of  Earth  Rate 
Up  Component  of  Earth  Rate 

Components  of  Angular  Velocity  of  Nav 
Frame  with  respect  to  Earth 

Components  of  Angular  Velocity  of  Nav 
Frame  with  respect  to  Inertial  Space 


Table  2.  Notation  used  in  Figures  1  and  4 
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Coordinate  Systems 

The  basic  Pinson  error  model  is  often  implemented  in  an  east- 
north-up  (e,n,u)  navigation  coordinate  frame.  However,  the  gyro  and 
accelerometer  sensitive  axes  are  assumed  to  be  nominally  aligned  along 
the  axes  of  an  aircraft  body  frame  orientated  in  a  nose,  right-wing, 
down  (x,y,z)  direction.  Therefore,  it  will  be  necessary  to  transform 
the  sensor  noises  derived  iri  the  body  frame  to  the  navigation  frame 
prior  to  using  them  as  a  driving  force  for  the  basic  error  differential 
equations.  Using  the  notation 

d>  =  Roll  Euler  Angle 
8  =  Pitch  Euler  Angle 
t  =  Yaw  Euler  Angle 


and  referring  to  Figure  2,  the  transformation  from  the  body  frame  to 
the  navigation  frame,  C”,  is 


rc 

C 

c 

ex 

ey 

ez 

C 

C 

C 

nx 

ny 

nz 

C 

C 

C 

.  ux 

uy 

uz. 

(2) 


where 


Cgx  =  s1ntcos6 

Cnx  =  costcose 

C  =  sin6 
ux 

Cey  a  sintsinQsint  +  costcost 
Cny  =  costs  inQsint  -  sintcost 
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0k  W 


I 


C  =  -cosQsIrvji 

C  5  -cos^sln^  +  sin^sin9cos<fr 

€Z 

C  =  cos^sinQcos<()  +  sin'J'sirrfr 
nz 

Cuz  =  ’COS0COS^ 

In  addition  to  the  above  transformation,  the  output  of  the 
flight  profile  generator,  PROFGEN,  will  also  have  to  be  transformed 
to  the  navigation  and  body  frames.  The  necessary  transformation  from 
the  PROFGEN  frame  to  the  navigation  frame  used  here,  C^,  is 

0  -1  0 

Cp  =  1  0  0  (3) 

0  0  1. 

This  transformation  is  done  implicitly  in  the  simulation  by  equating 
the  west  components  of  PROFGEN's  output  to  the  respective  negative  east 
components  in  the  error  model. 

After  transforming  to  the  proper  navigation  frame,  both  specific 
force  and  angular  velocity  must  also  be  transformed  to  the  body  frame. 
This  transformation  is  the  inverse  of  that  given  in  Equation  (2)  and 
is  defined  as 

C  C  C  fc  C  C 

xe  xn  xu  ex  ey  ez 

C  C  C  =  C  C  C 
ye  yn  yu  nx  ny  nz 

C  C  C  C  C  C 

ze  zn  zuj  L  ux  uy  uz 

Altitude  Channel  Mechanization 

Since  a  three-accelerometer  reference  system  will  be  used,  arid 
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the  vertical  channel  of  an  unaided  inertial  reference  system  is  in¬ 
herently  unstable,  external  aiding  will  be  used  in  the  vertical  com¬ 
putations.  (Ref  17:13)  To  minimize  the  vertical  error,  a  barometric 
altimeter  input  will  be  implemented  in  a  third  order  feedback  loop. 
The  error  aiding  equations  used  here  are 


uh  =  "K](|5h  ‘  6href^ 

(5) 

'vu  =  -¥5h  -  6href> 

(6) 

Ja  =  K3(6h  -  6href) 

(7) 

where 

uh  =  rate  of  correction  of  indicated  altitude 
uvu  =  rate  of  correction  of  vertical  vel .  error 
<5h  =  indicated  altitude  error,  State  x(3) 

6href  s  barometric  altitude  error 

3a  =  difference  of  integral  of  indicated  and 
barometric  altitude,  used  as  an  additional 
state,  x( 1 0) 

Equations  (5)  and  (6)  are  used  as  additional  driving  forces  for 
the  differential  equations  of  states  x(3)  and  x(6)  respectively,  and 
Equation  (7)  is  added  to  the  system  as  an  additional  state,  x(10).  The 
altitude  channel  equations,  including  these  aiding  equations,  then 
become 

M3)  =  x(6)  -  K]  (x(6)  -  6href)  (8) 

x(6)  =  -2Huvex(2)  +  F63x(3)  -  1^ ( x (3 )  -  5href) 

+  2onx(4)  -  2pex(5)  -  fpx(7)  +  fgx(8)  -  x(10) 
x(10)  =  K3(x(3)  -  Shref) 
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(9) 

(10) 


The  value  of  the  gains  K^,  and  have  been  arbitrarily 
chosen  so  that  the  charcaterlstic  equation  of  the  baro-altitude  loop 
has  a  triple  pole  at  s  -  -.01  sec"1  which  provides  stable  feedback  in 
a  loop  with  a  time  constant  of  about  100  seconds.  Such  a  design  was 
used  in  the  Litton  CAINS  inertial  navigator  (Ref  17:16).  These  va’ues 


K.j  =  3  x  10'2  sec’1 

*2  =  3  x  10"4  sec"2 
K.J  =  1  x  10~6  sec"^ 

The  results  of  using  these  gains  will  be  discussed  in  the 
verification  section  to  follow. 

Gyro  Error  Model 

The  Honeywell  GG1342  ring  laser  gyro  was  chosen  as  a  represent¬ 
ative  state-of-the-art  gyro  to  be  used  in  this  simulation.  It  is  a 
0.63  micron  (visible  red)  wavelength  gyro  with  a  34.5  centimeter  path 
length  and  uses  body  dither  for  lock-in  compensation.  Mechanical 
dithering  is  accomplished  by  piezoelectric  transducers  oscillating  the 
lasing  block  through  a  small  angle  to  minimize  dwell  time  in  the  lock- 
in  zone.  As  the  block  passes  through  lock-in  a  residual  error,  random 
rate  noise,  is  introduced  which  should  be  accounted  for  in  the  devel¬ 
opment  of  the  error  model . 

This  type  of  gyro  was  recently  flight  tested  by  the  Naval  Air 
Development  Center  in  the  A-7E  aircraft.  Benign  maneuvers  as  well  as 
air-to-air  combat  maneuvers  were  performed  during  these  tests.  Results 
showed  a  median  of  an  ensemble  of  radial  position  error  rates  of  less 
than  0.75  nautical  miles  per  hour  could  be  achieved  using  only  a  six 
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minute  alignment.  Ground  tests  showed  that  the  six  minute  alignment 
produced  an  RMS  alignment  error  in  azimuth  of  3.75  arc  min  (Ref  2). 

For  the  investigation  undertaken  here,  one  of  these  gyros  will 
be  assumed  to  be  nominally  aligned  along  each  of  the  pitch,  roll,  and 
yaw  axis  of  the  aircraft.  This  is  a  simplification  for  analysis 
purposes.  In  general,  a  better  gyro  is  used  for  the  roll  axis,  or  the 
greater  dynamic  range  of  the  roll  axis  is  distributed  by  canting  the 
input  axes  of  the  gyros  in  relation  to  the  roll  axis.  The  performance 
characteristics  assumed  for  each  gyro  are  listed  in  Table  3. 

Bias  stability,  scale  factor  stability,  and  input  axis  orthogon¬ 
ality  errors  will  be  achieved  iri  the  simulation  by  augmenting  the  basic 
ten-by-ten  error  model  with  additional  states.  These  states  will  be 
derived  from  differential  equations  of  the  form 


x  =  0 


That  is,  they  will  be  modelled  as  random  biases,  and  obtained  as  the 
output  of  integrators  with  no  input,  but  with  an  initial  condition 
modelled  as  a  Gaussian  random  variable  based  upon  the  given  standard 
deviations  (Ref  8). 

Random  drift  of  the  laser  gyro  will  be  modelled  as  a  white 
usslan  noise  driving  the  attitude  tilt  error  states  of  the  Pinson 
error  model . 

In  addition  to  the  error  model  characteristics  shown  in  Table  3, 
a  scale  factor  nonlinearity  typical  of  all  dithered  laser  gyros  (Ref  1) 
will  be  inserted  in  the  model.  A  describing  function  for  this  non¬ 
linearity  was  obtained  from  Dr.  Jack  W.  Bell  of  the  Air  Force  Avionics 
Laboratory  (Ref  3)  as 
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Error  Source 

Standard  Deviation 

Bias  Stability 

0.008  deg/hr 

Random  Drift 

0.002  deg/ /hr 

Scale  Factor  Stability 

5  PPM 

Inout  Axis  Misalignment 

25  prad 

Table  3.  6G1342  Laser  Gyro  Performance  Characteristics 


GSFout  =  GSFin  +  ^  '  Bl“l  +  C  02) 

where 


GSF  8  Gyro  Scale  Factor  (GSF1n  is  nominally  131328.387) 
u  =  Input  Axis  Angular  Velocity  In  deg/sec 
A  =  19.444  x  10"3  (pulses/rad) (sec/deg)^ 

B  =  4.277777  (pulses/rad) (sec/deg) 

C  =  217.78622  pulses/rad 

The  describing  function  is  valid  for  the  region 

80  deg/sec  <  |co|  <  140  deg/sec 

and  Is  based  upon  a  nominal  scale  factor  of  131328.387  pulses/rad. 
Outside  the  above  region  of  application  the  scaling  Is  assumed  to  be 
linear.  The  error  contribution  of  this  describing  function  is  plotted 
in  Figure  3. 

To  convert  this  function  so  that  It  may  be  applied  to  the  error 
model  used  here  it  is  necessary  to  divide  through  by  the  nominal 
scale  factor  and  convert  the  region  of  application  from  deg/sec  to 
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Figure  3*  Scale  Factor  Nonlinearity  (Nominal  Scale  Factor 
•  131328.387  pulses/rad) 


rad/sec.  This  results  in  the  function 


GSFout  =  GSF1n  +  A'“2  "  B'M  +  C' 


where 


6SF  =  Gyro  Scale  Factor  (GSF-n  is  nominally  1) 
a)  =  Input  Axis  Angular  Velocity  in  rad/sec 
A'  =  4.86039  x  10'4  (sec/rad)2 
B'  =  1.8663  x  10'3  sec/rad 
C'  =  1.65833  x  10"3 


This  function  is  valid  in  the  region 


1.3963  rad/sec  <  |oi[  <  2.4435  rad/sec 


The  contribution  of  the  scale  factor  nonlinearity  to  the  overall 
scale  factor  error  is  shown  in  Table  4  for  selected  input  rates. 
Although  Figure  3  does  represent  the  form  of  t’(e  nonlinearity  described 
in  Reference  1,  the  magnitude  of  the  error  contribution  shown  in  the 
third  column  of  Table  4  appears  to  be  high.  Scale  factor  linearities 
for  three  Honeywell  GG1342  gyros  discussed  in  Reference  2  are  given  as 
3.1,  2.5,  and  1.1  PPM.  Based  on  these  figures,  the  describing  function 
for  the  nonlinearity  given  in  Equation  (13)  will  be  scaled  down  such 
that  its  maximum  value  will  be  equal  to  the  midvalue,  2.5  PPM.  This 
reduced  error  contribution  Is  shown  in  the  fourth  column  of  Table  4. 

The  effect  of  this  and  alternative  choices  will  be  shown  in  the  sub¬ 
sequent  validation  section. 
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Error  Source 

Standard  Deviation 

8ias 

Repeatability 

10  yg 

White  Noise 

5  yg/sec 

Correlated  Noise  (t  =  60  sec) 

7  yg 

Scale  Factor 

Stability 

15  PPM 

Quadratic 

0.09  yg/g2 

Cross  Axes 

0.20  yg/g2 

Cubic 

0.0007  yg/g3 

Orthogonality 

10  arc  sec 

Gain  Change  Stability 

Bias 

10  yg 

Scale  Factor 

5  PPM 

Table  5.  Bell  Model  XI  Accelerometer  Error  Model 


Accelerometer  Error  Model 

Although  the  Systron  Donner  accelerometer  is  currently  used  In 
the  Honeywell  ring  laser  gyro  navigator  (RLGN),  the  Bell  Model  XI 
accelerometer  was  chosen  for  this  study  because  of  its  better  and  more 
state-of-the-art  performance  characteristics.  The  Bell  Model  XI 
accelerometer  Is  a  single  axis,  pendulous  proofmass,  force  rebalance 
device  which  uses  a  capacative  bridge  pickoff  to  detect  specific 
force.  The  parameters  for  the  basic  error  model  for  this  accelerometer 
are  shown  in  Table  5.  Long  term  errors,  temperature  compensation 
errors,  and  errors  induced  from  a  specific  onboard  computer  implementat- 


19 


Ion  were  not  considered  in  this  model.  It  is  assumed  that  temperature 
compensation  and  computer  processing  will  be  designed  such  that  the 
dominant  short  term  errors  will  be  those  listed  in  Table  5. 

Bias  stability  will  be  modeled  as  a  random  constant  with  a 
standard  deviation  based  upon  the  RMS  value  of  the  two  terms  given  in 
the  table 

/(10pg)2  +  (lOyg)2  =  14.14  pg  =  4.55376  x  10"4  ft/sec2  (14) 

This  value  will  be  the  basis  of  the  random  initial  condition  of  an 
undriven  integrator  used  to  generate  the  random  constant. 

The  white  Gaussian  noise  given  in  the  model  will  directly  drive 
the  differential  equations  for  the  three  velocity  states  in  the  basic 
Pinson  error  model.  Transformation  from  the  body  frame  to  the  nav¬ 
igation  frame  is  not  necessary  because  the  strength  of  the  noise  is  the 
same  for  all  three  axes.  Since  the  noise  is  spherically  distributed, 
a  rotation  of  the  reference  frame  still  results  in  the  same  statistical 
characteristics  for  the  noise  driving  each  axis. 

The  correlated  noise  bias  will  be  modeled  as  a  stationary  first 
order  Gauss-Markov  process  (Ref  8:183).  That  is,  the  differential 
equation  for  the  state  will  be  that  of  a  first  order  lag  driven  by 
white  Gaussian  noise  of  strength  Q  where 

Q  =  2o2/t  =  2(7pg)2/(60sec)  =  1.6935  x  10'9  ft2/sec3  (15) 

The  remaining  error  sources  will  be  modeled  as  random  constants. 
The  scale  factor  stability  terms  will  be  combined  to  obtain  a  standard 
deviation  of 
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(16) 


1  c 


/( 15  PPM)2  +  (5  PPM)2  =  1.5811388  x  10*5 


The  placard  acceleration  limit  for  the  F15  is  7.5 
was  used  to  determine  the  relative  contribution  of  each 
with  the  acceleration  applied  both  along  the  input  axis 
between  axes.  The  equation  used  to  calculate  indicated 
A.,  IS 


g.  This  value 
error  source 
and  45  degrees 
acceleration, 


A,  =  K.  +  K.a.  +  K,.a.2  +  K  a  2  +  K  a  2 
l  b  it  ni  pp  p  oo  o 

+  K.  a. a  +  K.  a. a  +  K  a  a 
ip  i  p  io  1  o  po  p  o 

+  K. . .a.3  +  K  a  3  +  K  a3 
m  i  ppp  p  ooo  o 


(17) 


where 


ai’ap’ao  *  acceleratl°n  along  input,  pendulous 
or  output  axis 

K.  =  bias  coefficient 

b 

K.  =  scale  factor  coefficient 

Ki1,Kpp,Koo  =  (luadratic  nonlinearity  coefficients 

K.  »K  ,K .  =  cross  axis  nonlinearity  coefficients 

io  po  ip 

K...,K  ,K  „  =  cubic  nonlinearity  coefficients 
ni  ooo  ppp 

As  shown  in  Table  6,  the  contribution  of  the  cubic  error  is  an  order  of 
magnitude  less  than  the  other  error  sources.  Thus,  it  will  not  be  in¬ 
cluded  in  the  error  model  used  in  this  simulation. 

Therefore,  for  the  accelerometers  to  be  modeled,  eleven  addition¬ 
al  states  will  be  added  to  the  basic  error  model  for  each  accelerometer. 
One  state  will  generate  correlated  noise,  while  ten  states  will  rep¬ 
resent  random  constants. 
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Error  (ug) 

7.5  g  Along  Input  Axis 

0 

7.5  g  45  between  axes 

j 

Bias 

14.14 

14.14 

Scale  Factor 

118.5854 

83.8525 

• 

Quadratic 

5.0625 

2.53 

Cross  Axes 

0.0 

5.625 

Cubic 

0.295 

0.1044 

f 

Table  6.  Contribution  of  Accelerometer  Error  Sources 

Gravity  Error  Model 

The  gravity  error  model  consists  of  local  variations  of  the  grav¬ 
ity  vector  which  are  not  normally  compensated  for  in  inertial  reference 
systems.  Both  gravity  deflections  and  gravity  anomaly  are  modeled  as 
first  order  Gauss-Markov  processes  with  the  correlation  time  derived 
from  the  vehicle  speed  and  spatial  correlation  distance  {Ref  17).  This 
is  shown  by 


i 

1 


i 


i 

4 

4 

i 


i 


where 


x  =  -  +  w  (18)  ; 

4 

4 

v  =  Vehicle  Ground  Speed 
d  =  Correlation  Distance 
x  =  Error  State 
w  =  White  Noise  of  Strength  Q 
Q  *  2o2v/d 


The  gravity  variation  model  given  in  Reference  17  for  the  western 
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r~ - - - - 

Gravity  Error 

Standard  Deviation 

Distance 

East-West  Deflection 

26  yg 

10  nm 

North-South  Deflection 

17  yg 

10  nm 

Anomaly 

35  yg 

60  nm 

Table  7.  Model  for  Gravity  Variations  (Ref  17) 


United  States  is  shown  in  Table  7. 

Barometric  Altimeter  Error  Model 

The  barometric  altimeter  is  used  in  this  simulation  to  stabilize 
the  vertical  velocity  and  altitude.  Two  sources  of  error  will  be 
modeled,  the  scale  factor  error  due  to  nonstandard  temperature  and  the 
error  due  to  the  variation  in  altitude  of  a  constant  pressure  surface. 

The  nonstandard  temperature  error  will  be  modeled  as  a  random 
constant  with  a  standard  deviation  of  0.03.  The  variation  of  the 
pressure  surface  will  be  modeled  as  a  spatial  first  order  Gauss-Markov 
process  with  a  correlation  distance  of  250  nm  and  a  standard  deviation 
of  500  feet  (Ref  17). 

Complete  Truth  Model 

The  complete  truth  model  of  the  errors  for  the  strapdown  inertial 
reference  system  consists  of  60  error  states  basically  of  the  form 

x  =  Fx  tw  (19) 

Each  of  these  states,  x,  are  defined  in  Table  8.  The  fundamental 
matrix,  F,  for  the  truth  model  is  shown  in  Figure  4  with  an  explanation 
of  its  entries  in  Tables  2  and  9.  The  strengths  of  driving  v/hite 
Gaussian  noise  terms,  w,  are  given  in  Table  10. 
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Meaning 

ao 

Basic  Altitude  Damped  INS 

Error  in  East  Longitude 

5.7735  x  10"2  arc  min 

Error  in  North  Latitude 

.2 

5.7735  x  10  arc  min 

Error  in  Altitude 

Equation  (21) 

Error  in  East  Velocity 

1  ft/sec 

Error  in  North  Velocity 

1  ft/sec 

Error  in  Vertical  Velocity 

0.1  ft/sec 

Attitude  Error  East  Component 

Equation  (23) 

Attitude  Error  North  Component 

Equation  (25) 

Attitude  Error  Up  Component 

Equation  (27) 

Altitude  Stabilization  Error 

Equation  (29) 

Gyro  Error  States 

x  Gyro  Bias 

0.008  deg/hr 

y  Gyro  Bias 

0.008  der/hr 

z  Gyro  Bias 

0.008  deg/hr 

x  Gyro  Scale  Factor  Error 

5  PPM 

y  Gyro  Scale  Factor  Error 

5  PPM 

z  Gyro  Scale  Factor  Error 

5  PPM 

x  Gyro  Misalign  about  y 

25  urad 

x  Gyro  Misalign  about  z 

25  urad 

y  Gyro  Misalign  about  x 

25  urad 

y  Gyro  Misalign  about  z 

25  urad 

Table  8.  Error  States  and  Initial  Standard  Deviations 


State 

Meaning 

°o 

x(21) 

2  Gyro  Misalign  about  x 

25  urad 

x(22) 

2  Gyro  Misalign  about  y 

Accelerometer  Error  States 

25  urad 

x(23) 

x  Accelerometer  Bias 

14.14  ug 

x  ( 24 ) 

y  Accelerometer  Bias 

14.14  ug 

x  ( 25 ) 

z  Accelerometer  Bias 

14.14  ug 

x  ( 26 ) 

x  Accel.  Correlated  Noise 

7  ug 

x(27) 

y  Accel.  Correlated  Noise 

7  ug 

x(28) 

2  Accel.  Correlated  Noise 

7  ug 

x(29) 

x  Accel .  Input  Quadratic 

0.09  ug/g 

x(30) 

y  Accel,  x  Cross  Quadratic 

0.09  ug/g 

x(31 ) 

2  Accel,  x  Cross  Quadratic 

0.09  ug/g 

x(32) 

x  Accel,  y  Cross  Quadratic 

0.09  ug/g 

x  ( 33 ) 

y  Accel.  Input  Quadratic 

0.09  ug/g 

x(34) 

2  Accel,  y  Cross  Quadratic 

0.09  ug/g 

x(35) 

x  Accel,  z  Cross  Quadratic 

0.09  ug/g 

x(36) 

y  Accel,  z  Cross  Quadratic 

0.09  ug/g 

x(37) 

z  Accel.  Input  Quadratic 

0.09  ug/g 

x  ( 38 ) 

x  Accel,  x,  y  Cross  Scale  Factor 

0.2  ug/g2 

x(39) 

y  Accel,  x,  y  Cross  Scale  Factor 

0.2  ug/g2 

x(40) 

z  Accel,  x,  y  Cross  Scale  Factor 

0.2  ug/g2 

Table  8.  (continued) 


2 

2 

2 

2 

2 

2 

2 

2 

2 
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State 

Meaning 

x(41 ) 

x  Accel,  x,  z  Cross  Scale  Factor 

x(42) 

y  Accel,  x,  z  Cross  Scale  Factor 

x(43) 

z  Accel,  x,  z  Cross  Scale  Factor 

x(44) 

x  Accel,  y,  z  Cross  Scale  Factor 

x  ( 45 ) 

y  Accel,  y,  z  Cross  Scale  Factor 

x(46) 

z  Accei .  y,  z  Cross  Scale  Factor 

x  ( 47 ) 

x  Accelerometer  Scale  Factor 

x(48) 

y  Accelerometer  Scale  Factor 

x  ( 49 ) 

z  Accelerometer  Scale  Factor 

x(50) 

x  Accel.  Misalign  about  y 

x  ( 51 ) 

x  Accel.  Misalign  about  z 

x  ( 52 ) 

y  Accel.  Misalign  about  x 

x(53) 

y  Accel.  Misalign  about  z 

x(54) 

z  Accel.  Misalign  about  x 

x  ( 55 ) 

1 

z  Accel.  Misalign  about  y 

! 

1 

Altimeter  Error  States 

x  ( 56 ) 

1 

Barometric  Pressure  Error 

'  x ( 57 ) 

Barometric  Scale  Factor  Error 

i 

Gravity  Model  Error  State 

x(58) 

East  Deflection  of  Gravity 

x  ( 59 ) 

North  Deflection  of  Gravity 

x  (60 ) 

Gravity  Anomaly 

0.2  pg/g2 
0-2  pg/g2 
0.2  pg/g2 
0.2  pg/g2 
0.2  pg/g2 
0.2  pg/g2 
IS  PPM 
15  PPM 
15  PPM 
10  arc  sec 
10  arc  sec 
10  arc  sec 
10  arc  sec 
10  arc  sec 
10  arc  sec 

0.03 
500  ft 

26  ug 
17  pg 
35  pg 


Table  8.  (continued) 


28 


V  in 

vo 

00 

M  N 

w 

<u  c 

3 

00 

CVJ 

O  <_) 

CO 

CSJ 

r*» 

>»  >. 

Of  c 

3* 

r^ 

o  <_> 

CO 

CVJ 

co 

X  X 

X 

<11  c 

3 

VO 

CNJ 

CO 

CVJ 

M  N 

M 

10 

41  C 

3 

40 

CVJ 

<J  o 

CO 

CVJ 

>>  >, 

>> 

01  e 

3 

«*• 

CVJ 

o  o 

CO 

CVJ 

CO 

X  X 

X 

o>  c 

3 

CO 

CVJ 

o  o 

CO 

CVJ 

vo 

CO 

Figure  4f.  Matrix  Fg 


56  57  58  59  60 


K1 

K^h 

0 

0 

0 

0 

0 

1 

0 

0 

0 

0 

0 

1 

0 

*2 

Kgh 

0 

0 

1 

0 

0 
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0 

0 
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0 
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Symbol  and  Value 

Meaning 

K.  =  3  x  10 

-2 

sec"^ 

1 

-4 

_2 

Gains  for  Altitude  Channel  ! 

K,  =  3  x  10 

sec 

C 

-6 

Aiding  Equations 

K3  =  1  x  10 

sec  J 

V  v  fz 

Specific  Force  in  Body  Frame 

wx*  wy*  uz 

Angular  Rate  in  Body  Frame 

h 

Altitude 

fc  C 

c 

ex  ey 

ez 

C".  the  Transformation  from  the 

C  C 

C 

D 

nx  ny 

nz 

Body  Frame  to  the  Nav  Frame 

C  C 

C 

ux  uy 

uzj 

t,  =  60  sec 

Accelerometer  Correlation 

r„  =  60  sec 

► 

Times 

3  =  60  sec 

V  =  /v  2  + 

e 

Ground  Speed 

dj  =  250  nm 

Accelerometer  Correlation  Distance 

d0  =  10  nm 

c 

Correlation  Distances 

d,  =  10  nm 

*■ 

0 

for  Gravity  Model 

d^  =  60  nm 

Table  9.  Notation  used  in  Figure  4. 


(See  Table  2  for  notation  used  in  Figure  4b) 
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Element 


Noise  Source 


Standard  Deviation 


w(4) 

Accelerometer  White  Noise 

5  yg/sec 

w(5) 

Accelerometer  White  Noise 

5  yg/sec 

w(6) 

Accelerometer  White  Noise 

5  p g/sec 

w(7) 

Gyro  Random  Drift 

0.002  deg//hr 

w(8) 

Gyro  Random  Drift 

0.002  deg//hr 

w(9) 

Gyro  Random  Drift 

0.002  deg/ /hr 

w(27) 

x  Accelerometer  Correlated  Noise 

^(7ug)li/(60sec) 

w(28) 

y  Accelerometer  Correlated  Noise 

/2(7pg)2/(60sec) 

w(29) 

z  Accelerometer  Correlated  Noise 

/2(7yg)?/(60sec) 

w(56) 

Barometric  Pressure 

/2(0.03)Zv/(250nm) 

w(58) 

East  Deflection  of  Gravity 

/2(26ug)2v/(10nm) 

w(59) 

North  Deflection  of  Gravity 

^2(17ug)2v/(10nm) 

w(60) 

Gravity  Anomaly 

— 

/2(35ug)2v/(60nm) 

Table  10.  Standard  Deviations  of  the  Non-zero  Elements  of  the 


Diagonal  Q  Matrix  for  Driving  Noise  w  where 
E{w(t)w{t  +  t)T}  =  Q6(t) 


Initial  Conditions 

The  initial  conditions  for  the  first  ten  states  will  be  based 
upon  a  ground  alignment  at  a  random  alignment  heading.  It  will  also  be 
assumed  that  the  baro-inertial  vertical  channel  has  already  reached  a 
steady  state  condition. 

Initial  longitude  and  latitude  error,  x(l)Q  and  x(2)q  will  be 
based  upon  the  accuracy  of  the  input  data  available  from  the  pilot.  It 
is  assumed  that  data  can  be  entered  through  the  inertial  reference 
system's  control  panel  to  within  ±0.1  arc  min.  The  standard  deviation 
for  this  uniformly  distributed  random  variable,  is 

oq  =  (0.2  arc  m1n)//l2  =  5.7735  x  10~^  arc  min  (20) 

For  eacn  run  of  the  Monte  Carlo  simulation,  a  random  sample  of  x(l)Q 
and  x(2)o  will  be  approximated  by  a  Gaussian  distributed  variable  based 
upon  the  standard  deviation  given  in  Equation  (20). 

The  initial  altitude  error,  x(3)q,  will  be  used  to  minimize  the 
start-up  transient  response  of  the  baro-inertial  loop  by  offsetting 
initial  barometric  altimeter  errors.  The  relationship  between  these 
variables  is  given  in  the  third  row  ot  the  fundamental  matrix  In 
Figure  4  as 

0  *  -K-|X(3)o  +  K]x(56)0  +  K]x(57)0h 
or 

x(3)0  =  x(56)q  +  x(57)0h  (21) 

Values  that  are  typically  obtained  from  a  ground  alignment  will 
be  used  to  specify  the  initial  standard  deviations  of  the  east  (o(4)Q), 
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north  (o{5)0),  and  up  (a( 6)Q)  velocities.  The  values  used  in  Reference 

17  are 


O (4)q  =  1  ft/sec 
c(5)o  «  1  ft/sec 
o(6)q  =  0.1  ft/sec 


East  and  north  attitude  errors,  x(7)Q  and  x(8)Q,  depend  upon  in¬ 
itial  accelerometer  and  gravity  errors.  During  alignment,  the  trans¬ 
formation  matrix  from  the  platform  reference  frame  (the  body  frame  in 
this  case)  to  the  navigation  frame  will  be  rotated  into  alignment  with 
the  sensed  gravity  vector.  This  results  in  initial  attitude  errors  that 
correspond  to  errors  in  the  sensed  gravity  vector.  The  contribution  of 
each  sensor  to  the  system  error  depends  upon  the  alignment  heading  of 
the  aircraft. 

The  relationship  between  initial  east  tilt  error,  x(7)Q,  and 
acceleration  errors  can  be  derived  from  row  five  of  the  fundamental 
matrix  shown  in  Figure  4.  With  the  aircraft  at  rest,  the  terms  of 
interest  are 


0  =  *<7)0fu  *  (x(23)0  ♦  x(26)0  +  x(35)0fzfz  -  x(50)ofz)Cnx 
*  (x(24)0  ♦  x(27)0  +  x(36)0fzfz  *  x{ 52 z ) C„y  *  x(59)0  (22) 

but  f  =  -f  =  g,  and  assuming  alignment  at  a  random  heading  i^D  we  have 

U  Z  K 

x(7)0  =  -(x(23)0/g  +  x(26)o/g  +  x(35)Qg  +  x(50)o)cos1|*R 
+  (x(24)Q/g  +  x(27)Q/g  +  x(36)og  -  x(52)Q)sin<|/R 
-  x(59)0/g  (23) 

Similarly,  the  fourth  row  of  the  fundamental  matrix  provides  the 
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(HWWfBN-Wi  ' 


relationship  for  initial  north  tilt  errors 


0  =  -  x(8)0fu  +  <x(24)0  t  x<27)„  ♦  x<36)0f2f2  +  x(52)0fz>Cey 

+(x(23)0  +x(26)Q  *  x(35)0f2f2  -  x(50)of2)Cex  +  x(58)  (24) 

Using  the  same  substitution  as  in  Equation  (23)  results  in 

x(8)q  =  (x(24)0/g  +  x(27)0/g  +  x(36)Qg  -  x(52)Q)cosij»R 
+  (x(23)0/g  +  x(26)0/g  +  x(35)Qg  +  x(50)Q)sin*R 
+  x(58)0/g  (25) 

East  gyro  errors  will  cause  an  initial  azimuth  error  since  a 
ground  alignment  seeks  to  null  east  angular  velocity.  From  the  compon¬ 
ents  of  the  east  tilt  rate  differential  equation,  row  seven  in  the 
fundamental  matrix  shown  in  Figure  4,  the  relationship  is  found  to  be 

0  =  '  x(9)oun 

+  (x(ll)0  +  X(14)0a,x  +  X(17)0a»z  -  x(18)^y)Cex 
+  (x(12)0  +  x(15)oWy  -  x(19)qUz  +  x(20)oU,x)Cey  (26) 

Since  the  aircraft  is  at  rest  and  aligned  at  a  random  heading 

o)  =  -w  =  n 
u  z  u 

“x  =  V0S*R 

",  ■ 

Substituting  these  values  into  Equation  (26)  gives 

x(9)0  =  (x(8)0«u  +  (x(ll)0  +  x(14)onncos*R 
-  x(17)0nu  +  x(18)0finsin*R)sin*R 
+  (x(12)q  -  x(15)onnsir^R  +  x(19)^u 
+  x(20)onncos^R)cos^R)/nn 


(27) 


The  initial  value  of  the  azimuth  error  shown  in  Equation  (27)  will 
apply  for  longer  alignment  times  (6  minutes  or  longer).  An  additional 
Gaussian  sample  based  on  a  standard  deviation  of  3  arc  min  will  be  add¬ 
ed  to  Equation  (27)  to  simulate  a  shorter  alignment  period  (approxi¬ 
mately  3  minutes).  These  values  correspond  to  RMS  azimuth  errors 
compiled  for  alignments  during  the  A-7E  flight  tests  (Ref  2). 

The  random  alignment  heading,  <<R,  will  be  realized  at  the  start 
of  each  Monte  Carlo  run  by  approximating  the  heading's  uniform  dist¬ 
ribution  from  -n  to  it  by  a  Gaussian  distribution  with  a  standard  dev¬ 
iation,  aR,  of 

aR  =  2tr//T2  =  1.8137993  rad 

Although  the  Gaussian  distribution  will  result  in  a  north  bias,  this 
type  of  randcr'  variable  generator  was  used  because  it  is  included  in  the 
basic  simulation  program,  SOFE.  Use  of  it  will  introduce  the  desired 
vari  ivi.  into  aircraft  heading  during  alignment,  and  will  reflect  the 
fact  the  aircraft  are  not  normally  parked  in  an  entirely  random  fashion. 

It  is  assumed  that  the  vertical  channel  is  in  steady  state;  there¬ 
fore  the  initial  value  of  state  x(10),  the  integral  of  the  difference 
between  computed  and  barometric  altitude,  will  be  set  to  compensate  for 
initial  vertical  velocity  errors.  The  relationship  between  these 
variables  can  be  obtained  from  the  sixth  row  of  the  fundamental  matrix 

0  =  *<3>oF63  '  x(10)o  +  (x(25)o  +  x(28)o  +  x(37)ofzfz 
+  x(49)Qfz)Cuz  -  K2(x(3)0  -  x(56)0  -  x(57)Qh)  +  x(60)Q  (28) 

but  initially 
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III.  Software 


The  primary  program  used  in  this  study  is  a  generalized  digital 
simulation  program  developed  by  the  Air  Force  Avionics  Laboratory 
called  SOFE  (Ref  12).  Two  additional  programs  used  in  conjunction  with 
SOFE  are  a  flight  profile  generator  called  PROFGEN  (Ref  11)  and  a  post¬ 
processor  called  SOFEPt  (Ref  6). 

SOFE 

This  section  will  show  how  SOFE  was  implemented  for  this  simula¬ 
tion.  Refer  to  Appendix  A  for  a  brief  discussion  of  the  program  itself. 
Normally  SOFE  is  used  to  implement  both  a  complete  truth  model  and  a  re¬ 
duced  order  Kalman  filter  model.  However,  SOFE  was  used  here  with  the 
order  of  the  filter  model  equal  to  the  truth  model.  No  measurements  are 
provided  to  the  filter  model  so  that  its  computed  covariance  is  the  un¬ 
conditional  state  covariance. 

The  truth  model  is  propagated  through  many  runs  and  is  used  as  the 
basis  of  a  Monte  Carlo  simulation  where  data  is  accumulated  such  that 
the  standard  deviation  of  the  error  states  can  be  calculated.  The  filter 
model  Is  propagated  through  one  run  and  used  as  the  basis  of  a  covari¬ 
ance  analysis.  Here,  the  square  roots  of  the  diagonal  elements  of  the 
covariance  matrix  are  computed  for  comparison  to  the  standard  deviations 
generated  by  the  truth  model  and  Monte  Carlo  sample  statistics  genera¬ 
tion. 

In  a  subsequent  validation  section  of  this  study,  the  results  of 
both  a  Monte  Carlo  simulation  and  a  covariance  analysis  for  a  strapdown 
inertial  reference  system  will  be  compared.  Based  on  this  comparison, 
the  Monte  Carlo  simulation  method  was  chosen  to  accomplish  the  error 
analysis  since  it  required  less  time.  A  second  reason  for  using  a  Monte 
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Carlo  simulation  is  that  the  scale  factor  nonlinearity  for  the  laser 
gyro  can  be  implemented  more  directly  than  in  a  covariance  analysis. 

The  subroutines  and  data  for  SOFE  that  implement  the  truth  model 
of  error  state  equations  developed  in  the  previous  section  are  listed  In 
Appendix  B.  Although  a  subroutine,  TRAJ,  is  available  in  SOFE  for  pro¬ 
gramming  of  trajectory  data,  an  external  flight  profile  generator, 
PROFGEN,  was  used  to  simplify  programming  and  enhance  versatility  in 
developing  trajectories. 

PROFGEN 

A  discretion  of  PROFGEN  is  included  in  Appendix  C.  PROFGEN  was 
programmed  to  construct  an  F4  flight  profile  during  the  development  of 
the  simulation  package,  followed  by  construction  of  two  basic  F15  flight 
profiles  for  use  in  the  error  analysis.  The  F4  flight  profile  was  devel¬ 
oped  and  is  currently  used  by  the  Air  Force  Avionics  Laboratory,  while 
the  FI 5  flight  profiles  were  developed  for  this  study  and  will  be  dis¬ 
cussed  In  a  subsequent  section. 

The  output  variables  of  PROFGEN  that  drive  the  simulation  program 
are  listed  in  Table  11.  PROFGEN  uses  a  north-west-up  navigation  frame 
which  is  implicitly  transformed  to  the  east-north-up  frame  used  here  by 
equating  the  corresponding  components  of  each  vector. 

Several  of  PROFGEN's  output  variables  require  transformations  prior 

to  being  used  as  driving  functions  in  the  error  model.  Specific  force 

b 

is  transformed  to  the  body  frame  from  the  navigation  frame  using  from 
Equation  (4)  as  shown  in 


rf  1  fC  C  C  ff 

x  xe  xn  xu  e 

f  C  C  C  f 

y  =  ye  yn  yu  n 

if  C  C  C  f 

zl  ze  zn  zul  pi 
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Table  11.  PROFGEN  Output 
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(  Angular  velocity  of  the  body  frame  with  respect  to  inertial 

space  is  found  from  the  sum  of  the  angular  velocity  of  the  navigation 
frame  with  respect  to  the  earth  and  the  angular  velocity  of  the  earth 
with  respect  to  inertial  space.  Coordinatizing  this  In  the  body  frame 
results  in 


( 


C 


using 


where 


SOFEPL 
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«  , 

£0  =  -V_/R 

e  n 

u  a  v/R  +  ncosL 
n  e 

%  *  (vetanl-)/R  +  folnL 


R  =  20925640  ft 
n  =  7.2921 151xl0'3  rad/sec 


(31) 


(32) 

(33) 

(34) 


SOFEPL  is  the  post  processor  which  is  used  in  conjunction  with 
SOFE  (Ref  6).  This  program  Is  used  to  compute  ensemble  averages  and 
standard  deviations  of  the  error  states.  The  graphics  package,  DISSPLA, 
is  used  by  SOFEPL  to  generate  a  plot  file.  Actual  plots  are  obtained 
by  using  the  DISSPLA  post  processor  that  corresponds  to  the  desired 


output  device. 
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IV.  Program  Validation 


The  error  model  for  the  strapdown  inertial  reference  system  was 
developed  in  detail  in  Section  II  and  implemented  in  software  as  des¬ 
cribed  in  Section  III.  It  remains  now  to  verify  that  the  error  state 
equations  and  their  implementation  are  correct,  and  that  the  results 
obtained  from  the  simulation  are  accurate. 

Two  approaches  are  to  be  used  to  verify  the  error  model.  First, 
the  implementation  of  the  basic  Pinson  error  model  is  to  be  checked  by 
comparing  plots  of  the  error  states  to  those  obtained  in  a  previously 
published  report  (Ref  17).  Then,  the  entire  error  model  will  be  imple¬ 
mented  in  two  different  manners,  a  truth  model  for  Monte  Carlo  simula¬ 
tions  and  a  filter  model  for  covariance  computations  (assuming  no  input 
measurements,  as  described  previously),  and  the  results  will  be  com¬ 
pared. 

In  addition,  the  number  of  runs  required  to  perform  a  Monte  Carlo 
simulation  will  be  ascertained,  and  the  stability  of  the  baro-inertial 
altitude  channel  will  be  investigated. 

Pinson  Error  Model  Verification 

The  response  of  an  unstable  pure  inertial  reference  system  and  a 
typical  stable  baro-inertial  system  to  various  initial  conditions  was 
investigated  by  Widnall  and  Grundy  (Ref  17:45-53).  They  showed  plots 
of  responses  of  an  unstable  system  to  an  initial  altitude  error  of  10  ft 
and  of  a  stable  system  to  initial  errors  of  100  ft  In  altitude  a”d 
1  ft/sec  *n  vertical  velocity. 

These  results  were  duplicated  by  selecting  the  proper  initial 
conditions  and  setting  to  zero  all  the  driving  noises  and  noise  states 
in  the  augmented  truth  model  leaving  the  basic  10  dimensional  error  model. 
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In  addition,  the  baro-inertial  aiding  gains  (K.,  K  ,  K  ')  were  set  to 

12  3 

zero  to  verify  the  unstable  system  response.  Typical  plots  that  were 
obtained  are  shown  in  Figures  5  and  6.  Latitude  and  longitude  errors 
resulting  from  an  initial  vertical  velocity  error  of  1  ft/sec  are  plotted 
over  a  2  hour  period.  As  expected,  a  small  amplitude  oscillation  occurs 
at  the  Schuler  frequency. 

Covariance  Analysis  versus  Monte  Carlo  Simulation 

Verification  of  the  complete  augmented  error  model,  including 
driving  noises,  was  done  by  comparing  the  results  of  a  Monte  Carlo  simu¬ 
lation  and  a  covariance  analysis  implemented  through  SOFE  as  described 
in  Appendix  A.  Rather  than  use  the  state-of-the-art  model  for  the  laser 
gyro  and  accelerometer  developed  in  Section  II,  error  characteristics  of 
older  generation  sensors  were  used  (Ref  7).  Essentially,  this  results  In 
the  same  basic  error  equations  but  different  initial  conditions  and 
driving  noise  strength'.  These  error  model  values  are  listed  in  Appendix 
E.  The  benefit  of  using  sensors  with  higher  noise  characteristics  is 
that  it  allows  for  easier  comparison  of  results  and  also  provides  a  base¬ 
line  whereby  the  introduction  of  better  sensors  should  cause  improved 
performance  in  the  simulation.  Another  consideration  in  using  the  older 
filter  model  is  that  the  gyro  scale  factor  nonlinearity  error  is  not 
addressed,  in  that  model,  thus  allowing  for  a  more  meaningful  comparison 
of  covariance  computations  and  Monte  Carlo  statistics. 

Both  the  truth  model  and  the  filter  model  of  the  strapdown  inertial 
reference  system  were  driven  by  the  same  highly  dynamic  flight  trajectory. 
This  flight  profile  was  developed  by  the  Air  Force  Avionics  Laboratory 
and  simulates  an  F4  In  combat.  The  system's  response  to  the  specific 
profile  was  not  considered;  rather,  the  differences  between  the  filter 
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model  and  the  truth  model  responses  were  compared.  Plots  of  position, 
velocity,  and  tilt  errors  resulting  from  a  50  run  Monte  Carlo  simulation 
using  the  truth  model,  and  the  covariance  matrix  of  the  filter  model  are 
shown  in  Figures  7  through  24.  For  the  truth  model  plots,  the  dashed 
lines  represent  the  average  plus  or  minus  one  standard  deviation,  and 
the  solid  line  represents  that  ensemble  average  itself.  The  dashed  lines 
on  the  filter  model  plots  represent  the  square  root,  of  the  diagonal 
element  of  the  covariance  matrix  associated  with  that  error  state, 
added  to  or  subtracted  from  the  assumed  mean  of  zero. 

Comparison  of  the  plots  obtained  from  each  model  shows  that,  al¬ 
though,  there  are  some  higher  frequency  variations  in  the  truth  model, 
the  basic  trends  of  each  model  are  nearly  identical.  It  is  presumed 
that,  in  the  limit,  as  the  number  of  Monte  Carlo  runs  is  increased,  the 
differences  between  the  results  obtained  from  the  two  models  will  vanish. 
However,  for  the  purposes  of  the  study  undertaken  here,  the  errors  pre¬ 
sent  in  the  50  run  Monte  Carlo  simulation  should  be  entirely  acceptable. 
Also,  after  comparing  the  plots  from  each  model  it  was  concluded  that 
the  error  models  had  been  implemented  correctly  since  two  different 
methods  of  implementation  of  the  same  system  error  model  produced  essen¬ 
tially  the  same  results. 

Since  comparable  statistics  were  obtained  from  both  Monte  Carlo 
and  covariance  propagation,  other  factors  must  be  weighed  in  the  selec¬ 
tion  of  one  of  these  models  to  perform  the  error  analysis.  Although  the 
filter  model  requires  only  one  run  to  generate  the  error  statistics, 
approximately  the  same  amount  of  computer  time  is  needed  to  generate  a 
50  run  Monte  Carlo  simulation.  Since  these  run  times  are  relatively 
large,  a  significant  savings  could  be  achieved  by  using  the  Monte  Carlo 
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LONGITUDE  ERROR  FIND  STAN  DEV'S  BASED  ON  50  RUNS 


0-0  100.0  300.0  300.0  too. a  B0.0  000.0  100.0  000.0  000.0  1000.0  1100.0  1300.0  1X0.0  IOOOlO 

rinc  (SCC) 


Figure  7.  Mean  and  Standard  Deviations  from  50  Runs 
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9.  Kean  and  Standard  Deviations  from  50  Runs 
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Figure  10.  Square  Root  of  Variance 
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ALTITUDE  ERROR  ANO  STAN  OEVS  BASED  ON  50  RUNS 
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Figure  11.  Mean  and  Standard  Deviations  from  50  Runs 


Figure  12.  Square  Root  of  Variance 


Figure  13.  Mean  and  Standard  Deviations  from  50  Runs 
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Figure  14.  Square  Root  of  Variance 
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Figure  15.  Mean  and  Standard  Deviations  from  50  Runs 
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Figure  16.  Square  Root  of  Variance 
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Firure  18.  Square  Hoot  of  Variance 


method  with  fewer  than  50  runs  to  set  up  the  problems  and  obtain  pre¬ 
liminary  data.  Also,  more  information  is  available  using  the  truth  model 
since,  not  only  standard  deviations,  but  ensemble  averages  of  the  error 
states  can  be  computed.  Finally,  the  nonlinear  gyro  scale  factor  error 
could  be  implemented  in  a  direct  fashion  in  the  truth  model,  but  would 
be  difficult  to  account  for  in  the  covariance  matrix  of  the  filter  model. 
Therefore,  the  Monte  Carlo  simulation  method  using  the  truth  model  was 
chosen  to  be  used  in  the  error  analysis. 

Number  of  Monte  Carlo  Runs 

It  is  desired  to  keep  the  number  of  Monte  Carlo  runs  as  small  as 
possible,  but  still  obtain  meaningful  results.  For  problem  setup  and 
debugging  one  run  is  sufficient,  but  the  data  generated  has  little  value 
since  it  is  jr  .  me  sample  from  a  random  process,  Using  the  same  F4 
trajectory  as  in  the  previous  comparison,  the  number  of  Monte  Carlo  runs 
was  decreased  from  50  to  20  runs.  Two  of  these  plots,  vertical  velocity 
and  azimuth  error,  are  shown  in  Figures  25  and  26.  Comparing  these  plots, 
respectively,  to  those  in  Figures  17  and  23  shows  some  delations,  but 
major  trends  are  still  very  much  the  same.  Plots  of  the  other  error 
states  show  even  less  variation  between  the  50  run  and  the  20  run  simu¬ 
lation.  Therefore  20  run  Monte  Carlo  simulations  will  be  used  for  pre¬ 
liminary  analysis  with  the  number  of  simulations  being  increased  to  50 
for  finer  detail  and  final  analysis. 

Baro-inertial  Gains 

One  portion  of  the  simulation  program  still  remains  to  be  investi¬ 
gated.  In  the  development  of  the  baro-inertial  aiding  equations  for  the 
vertical  channel  in  Section  II,  the  values  of  the  gains  ,  K^,  and 
were  arbitrarily  chosen  equal  to  magnitudes  previously  used  in  the 
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UP  VELOCITY  ERROR  AND  STAN  DEVS  BASEO  ON  20  RUNS 
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Figure  25>  Mean  and  Standard  Deviations  from  20  Runs 


AZIMUTH  ERROR  AND  SIAN  DEV’S  BASED  ON  20  RUNS 


Figure  26.  Mean  and  Standard  Deviations  from  20  Runs 
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Litton  CAINS  navigator  (Ref  17).  Referring  to  Figures  11  and  17,  alti¬ 
tude  and  vertical  velocity  error,  it  is  seen  these  values  of  gain  did 
produce  a  stable  vertival  channel:  the  primary  requirement  of  the  baro¬ 
metric  altitude  aiding. 

It  was  proposed  in  Reference  18  that  optimizing  techniques  could 
be  used  to  determine  gains  such  that  altitude  changes  could  be  tracked 
more  closely.  The  problem  encountered  in  applying  these  techniques  is 
that  the  gains  depend  upon  the  strengths  of  the  noises  present  in  the 
system.  Therefore,  the  best  results  would  be  obtained  by  optimizing 
the  gains  individually  for  each  different  inertial  reference  system.  A 
set  of  gains  proposed  in  Reference  18  for  a  typical  inertial  reference 
system  Is 

K]  =  1.003  sec"1 

K  =  4.17xlo"3  sec"2  (35) 

2  -6  -3 

Kg  *  4.39x10  sec 

These  values  were  inserted  in  the  simulation  and  flown  over  the 
same  F4  trajectory  that  was  used  previously.  Altitude  and  vertical  vel¬ 
ocity  errors  from  a  50  run  Monte  Carlo  simulation  are  shown  in  Figures 
27  and  28  respectively.  Comparing  these  to  Figures  11  and  17  shows  a 
smaller  standard  deviation  of  the  error  using  the  gains  in  Equation  (35). 
However,  the  new  values  of  gains  also  introduce  a  higher  frequency  com¬ 
ponent  in  variation  of  the  error.  This  higher  frequency  requires  a 
smaller  step  size  in  the  fifth  order  integrator  that  propagates  the  sim¬ 
ulation  and  results  in  considerably  longer  computer  run  times.  Although 
Figure  27  and  28  represented  an  improvement  in  the  system  error,  there 
was  no  detectable  difference  between  the  corresponding  plots  of  the 
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Figure  27.  Altitude  error  using  gains  in  Equation  (35) 
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Figure  28,  Up  velocity  error  using  gains  in  Equation  (35) 
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other  error  states.  Therefore,  In  an  effort  to  minimize  computer  run 
time,  the  original  gains  will  be  used  in  the  baro-inertial  altitude 
aiding  equations. 

State-of-the-Art  Error  Model 

The  basic  structure  of  the  inertial  reference  system  error  model 
was  developed  and  verified  using  older  generation  linear  models  of  the 
sensors.  One  of  the  objects  of  this  was  to  provide  a  baseline  such  that 
the  improved  sensors  should  show  better  error  characteristics  in  the 
simulation.  To  verify  this  assertion,  the  state-of-the-art  error  model 
developed  in  Section  II  was  driven  by  the  same  F4  trajectory  used  pre¬ 
viously.  The  plots  displayed  in  Figures  29  through  37  show  that  the 
standard  deviations  of  the  error  states  are  significantly  less  then 
those  in  Figures  7  through  23. 

/ 

In  the  development  of  the  gyro  scale  factor  nonlinearity,  the  peak 
error  contribution  was  scaled  to  match  empirical  scale  factor  linearity 
data.  The  relative  values  of  the  scale  factor  nonlinearity  and  the  other 
errors  in  the  model  suggest  that  the  nonlinearity  is  not  a  major  source 
of  error.  This  was  verified  by  using  the  same  flight  profile  with  a 
linear  gyro  scale  factor.  As  expected,  the  ensemble  average  of  the  error 
states  is  essentually  the  same  in  each  case.  Since  Figures  29  and  31 
showed  a  slight  tendency  to  deviate  from  a  zero  mean,  the  corresponding 
plots  for  the  linear  scale  factor  were  selected  and  are  shown  In 
Figures  38  and  39.  The  results  of  not  scaling  down  the  original  non¬ 
linear  describing  function  are  shown  in  Figures  40  and  41.  In  both  the 
longitude  and  east  velocity  plots  shown,  the  ensemble  averages  diverge 
considerably  from  a  zero  mean  value  resulting  in  the  nonlinearity  being 
the  dominant  error  source  for  the  inertial  reference  system. 
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LATITUDE  ERROR  AND  STFIN  DEVS  BASED  ON  50  RUNS 
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Ficure  30-  Frror  from  F4  trajectory 
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EAST  VELOCITY  ERROR  AND  STAN  DEV'S  BASED  ON  SO  RUNS 
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Figure  31.  Error  f rora . F4  trajectory 


NORTH  VELOCITY  ERROR  AND  STAN  DEV'S  BASED  ON  50  RUNS 
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Figure  32.  Error  from  F4  trajectory 
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EAST  TILT  ERROR  AND  STAN  DEV'S  BASED  ON  50  RUNS 
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Figure  35.  Error  from  F4  trajectory 


Figure  36.  Error  from  F4  trajectory 
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Figure  37,  Error  from  F4  trajectory 


V.  Flight  Profiles 


The  objective  of  the  flight  profile  development  is  to  provide  a 
highly  dynamic  environment  for  the  inertial  sensors  so  that  the  result¬ 
ing  reference  system  errors  can  be  studied.  Air  to  air  combat  appears 
to  be  one  of  the  most  dynamic  environments  for  an  aircraft;  therefore, 
the  flight  profiles  will  be  based  on  that  type  of  scenario.  The  approach 
will  be,  not  to  develop  specific  combat  maneuvers,  but  to  subject  the 
sensors  to  loads  typical  of  these  maneuvers. 

Two  types  of  dynamic  flight  profiles  will  be  developed  initially. 

A  "training"  mission  will  be  developed  containing  both  highly  dynamic 
and  sinusoidal  maneuvers.  This  will  follow  the  development  of  a  "combat" 
mission  with  more  severe  dynamic  maneuvers  and  less  sinusoidal  content. 
The  system  errors  generated  by  these  two  flight  profiles  will  be  the 
basis  of  the  subsequent  error  analysis. 

Performance 

The  FI 5  was  chosen  to  represent  today's  air  superiority  fighter 
aircraft  and  to  be  the  basis  for  the  construction  of  flight  profiles. 

The  data  in  Table  12  was  developed  as  a  guideline  for  performance  from 
many  sources  (Ref  11,  16).  This  table  was  compiled  to  represent  maximum 
performance  for  a  fighter  in  an  air  superiority  role  and  will  be  used 
as  the  upper  limit  in  the  flight  profile  development. 

Also,  as  an  aid  in  constructing  flight  profiles,  data  was  extracted 
from  a  tape  of  an  FI 5  air-to-air  combat  engagement  flown  during  aircraft 
combat  evaluation  tests  (ACEVAL)  at  Nellis  AFB  in  1977  (Ref  11). 

In  addition  to  aircraft  performance,  the  pilot's  ability  to  sus¬ 
tain  high  accelerations  must  also  be  considered.  This  data  was  developed 
by  the  Aerospace  Medical  Research  Laboratory  and  made  available  by 
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Performance 


Maximum  Value 


Nominal  Roll  Rate 

Roll  Time  Constant 

Forward  Acceleration 

Positive  Turn  Acceleration 

Negative  Turn  Acceleration 

Altitude 

Speed 

Range 


225  deg/sec 
0.5  sec 

1  g 

7.5  g 
3  g 

60,000  ft 
Mach  2.5 
350  nm  radius 


Table  12.  Repress cative  Fighter  Maximum  Performance 


Capt  Robert  A.  Mercier  (Ref  10).  The  average  acceleration  that  a  typi¬ 
cal  pilot  can  sustain  while  performing  combat  maneuvers  is  plotted  in 
Figure  42.  Average  g's  is  determined  by  the  equation 


Average  g's 


Accumulated  g's  x  Time  Held 
Time  in  Combat 


(36) 


The  pilot  retains  full  capacity  when  below  the  lower  line  of  the  plot 
and  passes  out  if  average  maneuver  acceleration  falls  above  the  upper 
line.  The  flight  profiles  developed  for  this  simulation  were  designed  to 
be  near  the  top  line  in  the  "combat"  mission  case  and  more  toward  the 
bottom  line  for  the  "training"  mission. 

Combat  Flight  Profile 

The  "combat"  flight  profile,  shown  in  Figures  43  through  47,  sim¬ 
ulates  the  highly  dynamic  loads  present  during  air  to  air  combat.  To 
conserve  computer  time,  the  mission  was  compre'  cteen  minutes 

from  takeoff  to  landing.  Each  of  the  50  maneuv  ied  for  this 

mission  are  listed  In  Table  13.  In  the  table,  time  Is  specified  In 
seconds  from  the  start  of  the  mission.  Acceleration  Is  divided  Into 
acceleration  along  the  path  of  the  flight  and  acceleration,  generated  by 
maneuvers,  which  is  tangential  to  the  flight  path. 

The  mission  starts  at  38  degrees  north  latitude,  75  degrees  west 
longitude,  at  an  altitude  of  200  feet.  From  this  point  the  aircraft 
initiates  a  maximum  performance  climb  up  to  a  cruise  altitude  of 
30,000  feet.  After  level  off,  the  airr^^Tu  ?ccelerates  to  supersonic 
airspeed  and  dashes  toward  the  point  of  interception.  The  pilot  looks 
down  by  performing  a  45  degree  roll,  followed  by  a  descent  to  10,000 
feet.  Highly  dynamic  combat  maneuvers  are  simulated  at  thi'  point  by 
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Table  13.  (continued) 


performing  an  arbitrary  series  of  high  acceleration  vertical  and  hori¬ 
zontal  turns.  This  is  followed  by  a  gradual  descent  toward  home  base 
which  includes  the  performance  of  a  360  degree  roll  and  a  400  degree 
turn.  The  mission  is  terminated  at  zero  velocity  near  the  starting 
point. 

It  should  be  noted  that  although  the  maximum  tangential  accelera¬ 
tion  Is  specified  the  same  (7.33  g's)  for  many  maneuvers  in  Table  13, 
this  is  not  the  acceleration  held  throughout  the  turn.  All  of  the  turns 
in  PROFGEN  are  coordinated;  therefore,  tangential  acceleration  starts  at 
zero  with  wings  level  and  increases  with  roll  angle  until  the  maximum 
is  reached.  Therefore  the  average  tangential  acceleration  sensed  for  a 
small  turn  at  low  airspeed  would  be  considerably  less  than  the  average 
for  a  large  turn  at  high  speed,  although  the  same  maximum  acceleration 
was  specified  for  each  case. 

Training  FI ight  Profile 

The  "training"  flight  profile,  shown  in  Figures  48  through  52, 
represents  less  severe  maneuvers  with  longer  durations  and  more  sinusoi¬ 
dal  motion.  Sinusoidal  maneuvers  will  be  performed  at  arbitrary  fre¬ 
quencies  to  determine,  in  general,  whether  errors  are  compounded  or  just 
oscillate.  Overall  time  for  this  profile,  15  minutes,  is  the  same  as  the 
combat  profile,  but  only  20  maneuvers  are  performed. 

The  starting  point  is  the  same  as  the  combat  profile,  but  in  the 
training  mission  a  gradual  cl’mbing  turn,  at  30  degrees  of  bank,  is  made 
to  cruise  altitude.  This  is  followed  by  sine  wave  maneuvers;  and  turns, 
rolls,  and  loops  of  360  degrees  or  more.  Each  maneuver  is  specified  in 
Table  14.  The  overall  errors  generated  by  these  large  maneuvers  will  be 
compared  to  the  overall  errors  induced  by  the  numerous  smaller  maneuvers 


Figure  52.  Training  flight  profile 


Segment  Time  Maneuver  Degrees  Tangent  g's  Path  g's 

1  •  0  '  Pitch  15  5.5  0.1 

!  I  t 

2  2  ,  Turn  285  0.577  0 

3  |  158.94  j  Pitch  -15  2  0.2 

4  :  165  |  Straight  0  0  j  0 


5  _  195  1  Sine  40  1  0 


Table  14.  Training  Flight  Profile 


in  the  other  flight  profile. 

In  the  development  of  the  previous  mission,  the  flight  profile 
generator,  PROfGEN,  was  found  to  exceed  the  aircrafts  performance  speci¬ 
fications  during  some  maneuvers.  This  resulted  in  the  modification  of 
PROFGEN  so  that  realistic  trajectories  could  be  generated.  These  changes 
will  also  be  used  here. 

As  with  the  combat  mission,  roll  and  turn  maneuvers  are  based  upon 
a  representative  roll  time  constant;  however,  the  sine  maneuver  is  not. 
The  equation  PROFGEN  used  to  compute  roll  rate,  i>»  is 

2 

•  _  64,4  v  i ji  u  cos2fait _ _ 

V  “  ?  ?  W'  / 

(32.2)  +  (v  \i>  w  sin2ut) 


where 


v  =  Total  Velocity 

\ji  =  Maximum  Heading  Change 

oj  =  Frequency  of  Sine  Maneuver 

At  t  =  0,  the  start  of  the  sine  maneuver,  roll  rate  is 
i  =  2  v  u2  /  32.2 

which  Is  the  maximum  value  of  Equation  (37).  Therefore,  even  if 
and  w  were  chosen  to  conform  to  the  aircraft's  roll  time  constant,  an 
unrealistic  maneuver  Is  performed  since  a  step  increase  in  the  value  of 
roll  rate  occurs  at  the  beginning  of  each  sine  maneuver  segment.  The 
step  input  will  have  to  be  taken  into  consideration  in  the  analysis  of 
the  errors  induced  by  the  training  flight  profile. 
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VI .  Error  Budget 

Each  type  of  error  source  will  be  propagated  seperately  over  a 
highly  dynamic  flight  trajectory  in  order  to  determine  the  relative  con¬ 
tribution  of  each  kind  of  the  sensor  errors  to  the  overall  inertial  re¬ 
ference  system  error.  The  "combat"  flight  profile  will  be  used  for  this 
analysis  since  it  contains  more  manuevers  with  higher  acceleration  loads 
than  the  "training"  flight  profile.  This  profile  should  generate  a 
broader  spectrum  of  system  errors  by  exciting  more  sensor  errors. 

The  plots  of  the  ensemble  averages  over  50  Monve  Carlo  runs  of  the 
error  states  from  each  error  source  plus  and  minus  one  standard  deviation 
(sigma)  will  be  compared  to  baseline  plots  obtained  from  propagating  just 
the  initial  conditions  with  no  sensor  errors.  These  baseline  plots  are 
shown  in  Figures  53  through  61.  Since  the  initial  values  of  tilt  and 
azimuth  errors  are  functions  of  many  of  the  sensor  errors,  these  initial 
conditions  will  change  depending  upon  the  particular  error  state  being 
analyzed. 

In  contrast  to  the  system  error  obtained  from  just  the  initial 
conditions,  Figures  62  through  70  are  plots  of  the  error  standard  de¬ 
viations  as  a  result  of  the  contributions  of  all  of  the  error  sources. 
These  plots  were  developed  based  upon  a  normal  long  alignment.  A 
shorter  allghnment,  as  will  be  shown  in  this  section,  would  generate  more 
system  error. 

The  second  column  of  Table  15  represents  the  percent  of  error, 
relative  to  the  error  generated  by  all  the  error  sources,  induced  into 
the  system  by  just  the  initial  conditions.  This  percentage  was  estimated 
by  comparing  the  maximum  value  of  the  standard  deviations  for  each  type 
of  plot.  For  subsequent  comparison  of  the  contribution  of  each  error 
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Figure  Ji4.  Latitude  error  -.-state  from  initial  conditions 


Figure  55,  Fast  vel.  error  state  from  initial  conditions 


Figure  56.  North  vel.  error  state  irom  initial  condition 
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Figure  57-  Altitude  error  state  from  initial  conditions 
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Figure  59.  East  tilt  error  state  from  initial  conditions 
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Figure  60. North  tilt  error  state  from  initial  conditions 
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Figure  61.  Azimuth  error  state  from  initial  conditions 
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Figure  65.  Eorth  vel.  error  state  from  all  noi 


ourccs 


ERRq^  +  FIND  -  'SIGMA,  50  RUNS,  COMBFIT,  FILL  NOISE,  SML  DTO 


iiic  iseci 


Figure  66.  Altitude  error  state  from  all  noise  sources 


Figure  67.  Up  vel.  error  state  from  all  noise  sources 
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Figure  68.  East  tilt  error  state  from  all  noise  sources 


Figure  69.  North  tilt  error  state  from  all  noise  source: 


source,  the  maximum  value  obtained  from  propagating  just  the  initial 
conditions  was  subtracted  from  the  maximum  obtained  with  the  error  source, 
then  the  percentage  is  computed.  In  all  cases,  the  final  value  of  the 
longitude  and  latitude  error  states  are  the  maximum  value.  The  vertical 
channel,  in  most  instances,  is  compared  at  the  peak  standard  deviation 
value  resulting  from  the  initial  climb.  In  addition  to  changing  the 
driving  forces  of  the  vertical  channel,  the  error  sources  also  change 
the  damping  of  this  closed  baro-inertial  loop.  In  some  cases  this  re¬ 
sults  in  variations  that  exceed  the  maximums  obtained  from  the  presence 
of  all  error  sources,  as  shown  in  the  fifth  column  of  Table  15.  Many 
of  the  standard  deviations  of  gyro  induced  tilt  errors  reached  maximum 
values  just  before  the  -400  degree  turn  at  t  =  737.5  seconds  cancelled 
much  of  the  error  built  up  by  turns  in  the  opposite  direction.  In  the 
cases  where  the  initial  velocity  standard  deviations  are  the  maximum 
value,  the  difference  between  the  standard  deviations  at  the  final  time 
was  the  basis  of  comparison. 

Additional  tables,  constructed  in  the  same  manner  as  Table  15,  will 
be  used  for  comparison  of  individual  accelerometer  errors  and  individual 
gyro  error  contributions  to  the  overall  system  error.  Since  the  contri¬ 
butions  of  error  sources  are  calculated  at  points  which  best  reflect 
their  relative  contribution  to  the  overall  error,  and  vertical  channel 
damping  is  variable;  the  square  root  of  the  sums  of  the  squares  (RSS)  of 
the  percentages  of  contribution  will  not,  in  general,  be  100  percent. 

It  should  also  be  noted  that  the  tables  show  some  error  sources 
contribute  more  to  one  of  the  horizontal  channels  than  the  other.  This 
is  a  result  of  the  predominatly  north-south  orientated  flignt  profile 
shown  in  Figure  43.  Therefore,  scale  factor  type  of  error  sources  would 
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cause  more  error  in  the  predominant  north-south  direction,  while  mis¬ 
alignments  would  couple  errors  into  the  perpendicular,  east-west  direc¬ 
tion. 

Table  16  was  developed  to  show  the  relative  contribution  of  the 
sensor  error  sources  to  the  initial  alignment  error  of  the  tilt  and 
azimuth  error  states.  This  percentage  was  derived  from  the  ratio  of  the 
standard  deviation  induced  by  an  individual  error  to  that  induced  by  all 
the  sensor  errors.  These  alignment  error  sources  are  not  independent, 
since  a  change  in  heading  will  increase  the  contribution  of  some  of  the 
sources,  while  decreasing  that  of  the  others.  Therefore,  especially  for 
azimuth,  the  RSS  value  of  all  the  percentages  of  contribution  will  not 
necessarily  be  100  percent. 

In  addition  to  these  tables,  a  word  description  rather  than  the 
Inclusion  of  a  plot  will  be  used  to  point  out  simple  trends  resulting 
from  the  error  sources.  The  plots  selected  to  illustrate  more  complex 
detail  have  been  consolidated  in  Appendix  H  since  they  will  be  referenced 
in  both  this  section  and  the  following  section. 

Accelerometer  Errors 

The  ensemble  averages  and  standard  deviations  of  the  error  states 
resulting  from  propagation  of  just  the  accelerometer  over  the  flight  tra¬ 
jectory  are  shown  in  Figures  H-l  through  H-9.  With  the  exception  of  the 
damped  vertical  channel,  virtually  none  of  the  dynamics  of  the  trajectory 
are  reflected  in  these  error  plots.  The  slight  variations  in  the  north 
velocity  error  correspond  to  large  turns  initialed  at  197,  398  and  735.5 
seconds. 

Accelerometer  errors,  through  the  relationships  in  Equations  (23) 
and  (25),  cause  most  of  the  tilt  errors  during  initial  alignment.  The 
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resulting  north  tilt  error,  in  turn,  causes  a  small  initial  azimuth  error 
due  to  the  first  term  in  Equation  (27).  The  standard  deviations  of  these 
initial  errors,  shown  in  Figures  H-7  through  H-9,  remain  relatively  con¬ 
stant  throughout  the  mission. 

The  third  column  in  Table  15  shows  the  percentage  of  error  (based 
on  comparison  of  maximum  values)  that  the  accelerometers  contribute  to 
the  overall  system  error.  Comparison  of  these  values  to  those  resulting 
from  just  the  initial  conditions  show  that,  in  general,  the  accelerometer 
errors  had  a  smaller  adverse  impact  on  the  performance  of  the  navigation 
system.  However,  introduction  of  the  accelerometer  errors  did  cause  more 
variation  of  error  in  vertical  channel  as  seen  by  comparing  Figures  H-5 
and  H-6  to  Figures  47  and  48. 

The  contributions  of  each  type  of  accelerometer  error  to  the  over¬ 
all  system  error  is  shown  in  Table  17.  Each  of  the  error  sources  will  be 
discussed. 

Accelerometer  Bias.  Accelerometer  bias,  as  shown  in  Table  16,  Is 
a  factor  in  the  initial  alignment  accuracy  of  the  tilt  error  states  and 
indirectly  has  a  small  effect  on  initial  azimuth  error.  These  three  add¬ 
itional  initial  errors  and  the  bias  errors  contribute  to  the  velocity 
differential  error  equations.  The  resulting  velocity  error  is  then  inte¬ 
grated  to  give  position  errors.  Both  position  and  velocity  errors  are 
terms  in  the  tilt  and  azimuth  differential  error  equations,  and  therefore 
the  cycle  continues. 

The  standard  deivations  of  tilt  and  azimuth  errors  grow  smoothly 
to  the  maximum  relative  relationship  shown  in  the  second  column  of 
Table  17.  This  same  linear  growth  is  also  true  for  the  latitude  and 
longitude  error  states.  The  horizontal  velocity  standard  deviations, 
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however,  start  at  their  maximum  value  and  gradually  decrease.  The  percent 
of  system  error  contributed  by  these  states  was  determined  by  comparison 
of  the  standard  deviations  at  the  final  time.  Slightly  more  oscillation 
than  that  observed  from  just  the  initial  conditions  was  apparent  in  the 
vertical  channel,  but  this  contribution  is  insignificant  relative  to  the 
total  vertical  error. 

Accelerometer  Scale  factor  Error.  Scale  factor  errors  contribute 
about  the  same  amount  of  error  to  the  system  as  accelerometer  bias  errors, 
as  a  result  of  this  flight  trajectory.  Unlike  bias,  the  scale  factor 
errors  do  not  contribute  to  the  initial  tilt  and  azimuth  alignment  errors, 
but  the  standard  deviations  of  these  error  states  grows  linearly  until 
the  maximum  is  about  equal  to  the  bias-induced  errors. 

Table  17  shows  that  the  horizontal  velocity  error  standard  de¬ 
viations  for  the  scale  factor  induced  errors  are  less  than  those  induced 
by  the  bias  errors.  Yet,  the  position  error  standard  deviations  are 
equal  to  or  greater  than  that  caused  by  the  bias  errors.  In  each  case, 
the  initial  velocity  error  standard  deviation  was  the  maximum  value 
followed  by  a  gradual  decrease.  However,  the  standard  deviation  for  scale 
factor  induced  velocity  error  remained  at  a  higher  value  longer  and  dropped 
slightly  faster  toward  the  end  of  the  mission.  Integration  of  the  higher 
average  velocity  error  resulted  in  more  scale  factor  induced  position 
error. 

Accelerometer  Misalignment.  Misalignment  is  the  dominant  source 
of  accelerometer  induced  system  errors.  The  third  column  of  Table  16 
shows  that  this  error  source  is  the  cause  of  most  of  the  initial  tilt 
errors  and  some  of  the  initial  azimuth  error.  Unlike  the  bias  induced 
initial  errors,  whose  standard  deviation  grew  as  the  flight  progressed, 
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these  three  higher  initial  standard  deviations  remained  relatively  con¬ 
stant  throughout  the  mission. 

The  standard  deviations  of  the  east  and  north  velocity  errors,  as 
shown  in  Table  17,  are  considerably  higher  for  the  misalignment  induced 
errors  than  any  other  accelerometer  error  source.  This  relatively  high 
velocity  error  would  have  a  large  impact  on  position  error  when  integrated 
over  a  longer  flight  profile. 

The  oscillations  produced  in  the  vertical  channel  are  nearly  iden¬ 
tical  in  size  and  in  shape  to  those  produced  by  the  combination  of  all 
accelerometer  errors  shown  in  Figures  H-5  and  H-6. 

Accelerometer  Second  Order  Errors.  Second  order  error  sources 
were  included  in  the  accelerometer  error  model  as  a  result  of  the  com¬ 
parison  of  their  maximum  impact  on  system  error  to  that  caused  by  other 
error  sources.  These  relationships  were  shown  in  Table  6.  The  percentages 
of  total  error  contributed  by  these  sources,  shown  in  Table  17,  confirm 
that  the  system  errors  generated  are  not  insignificant.  In  fact,  the 
standard  deviation  of  latitude  errors  and  north  velocity  error  contribute 
the  same  percentage  of  total  error  as  accelerometer  bias. 

When  the  quadratic  and  cross  scale  factor  second  order  error 
source  types  are  considered  seperately,  each  produces  the  same  percentage 
of  error  as  the  other.  However,  in  almost  every  error  state,  the  stan¬ 
dard  deviation  is  more  when  just  one  type  of  error  source  is  present  than 
when  the  two  second  order  sources  are  combined.  This  result  is  not  con¬ 
tradictory  since  specific  force  excites  both  of  these  error  sources,  but 
the  quadratic  error  remains  positive  while  the  cross  scale  factor  error 
changes  sign,  causing  some  cancellation  of  the  error. 

The  second  order  errors  cause  the  tilt  and  azimuth  standard 
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deviations  to  grow  linearly  from  zero  to  the  maximum  percentage  of  error 
shown  in  the  fifth  column  of  Table  17.  The  standard  deviations  of  posi¬ 
tion  errors  ^cart  at  their  initial  values  and  gradually  increase,  while 
the  velocity  error  states  gradually  decrease  from  their  initial  value. 

The  percentage  of  total  error  for  each  of  these  error  states  is  computed 
based  upon  their  relative  value  at  the  final  time. 

Accelerometer  Correlated  Noise.  Correlated  Noise  produced  a  sys¬ 
tem  error  similar  in  magnitude  to  that  of  bias  and  scale  factor  induced 
error.  Table  16  shows  that  this  noise  source  also  contributed  a  small 
amount  of  initial  alignment  error. 

Although  the  relative  magnitudes  vary  slightl',  as  seen  in  Table 
17,  the  system  plots  obtained  from  both  the  accelerometer  bias  and  cor¬ 
related  noise  are  nearly  identical  in  shape.  The  tilt,  azimuth  and  posi¬ 
tion  errors  gradually  grow  from  their  initial  values  to  the  maximum  per¬ 
centage  of  overall  error  shown  in  the  table.  The  velocity  errors  de¬ 
crease  gradually  from  their  initial  standard  deviations  until  the  final 
time  where  their  relative  contribution  is  tabulated.  Correlated  noise 
causes  slightly  more  oscillation  in  the  vertical  channel  than  the  accel¬ 
erometer  bias. 

Accelerometer  White  Gaussian  Noise.  Overall,  the  white  noise 
contribution  to  the  inertial  reference  system  error  is  the  least  signi¬ 
ficant  accelerometer  error  source.  Comparison  of  the  relative  values 
of  the  columns  of  Table  17  shows  that  in  several  error  states  even  second 
order  errors  were  considerably  greater  than  white  noise  induced  system 
errors . 

In  this  simulation  the  white  noise  contribution  is  added  directly 
to  the  velocity  error  states.  A  noise  sample,  weighted  by  the  time 
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interval  between  samples,  is  added  periodically  (every  two  seconds  in 
this  case)  to  simulate  the  driving  noise.  The  strength  of  the  noise  used 
here,  however,  is  not  sufficient  to  alter  trends  established  from  just 
the  initial  conditions.  Therefore,  the  velocity  error  standard  devia¬ 
tions  still  gradually  decrease  from  their  initial  values  but  end  at  a 
slightly  higher  percentage  of  total  velocity  error  than  those  caused  by 
just  the  initial  conditions.  Again,  position,  tilt  and  azimuth  errors 
gradually  grow  to  a  maximum  standard  deviation  at  the  final  time. 

Gyro  Errors 

Gyro  errors  are  the  dominant  source  of  error  for  this  strapdown 
inertial  reference  system.  The  system  errors  caused  by  the  gyro  error 
sources,  unlike  the  accelerometer  error  sources,  strongly  reflect  the  dy¬ 
namics  of  the  flight  trajectory  driving  the  simulation  program.  The 
standard  deviations  of  the  error  states  generated  by  just  the  gyro  errors 
(and  initial  conditions)  are  shown  in  Figures  H-10  through  H-18.  With 
the  exception  of  the  position  errors,  each  of  these  plots  show  variations 
due  to  specific  maneuvers. 

The  gyro  errors  are  terms  in  the  tilt  and  azimuth  differential 
equations.  These  error  states,  as  seen  in  columns  7,  8  and  9  of  Figure 
4b,  are  multiplied  by  specific  force  and  become  terms  in  the  velocity 
differential  equations.  Velocity  error  is  integrated  to  give  position 
error  and  both,  in  turn,  cause  more  tilt  error.  Each  integration  of  the 
induced  error  provides  some  smoothing,  therefore,  rapid  changes  in  tilt 
error  results  in  the  gradual  growth  of  position  error  shown  in  Figures 
H-10  and  H-l 1 . 

Through  the  alignment  process  of  nulling  the  east  component  of  the 
earth's  rotation  rate,  the  gyro  errors  contribute  most  of  the  initial 
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azimuth  error.  This  is  reflected  in  the  relative  percentages  of  total 
initial  error  shown  in  Table  16.  Figure  H- 1 0  shows  that  the  gyro  error 
sources  cause  the  standard  deviation  of  azimuth  error  to  remain  relatively 
constant  throughout  the  mission.  Comparison  of  the  percentages  of  total 
error  listed  in  Table  15  shows  that  this  is  the  major  source  of  azimuth 
error. 

The  gyro  errors  do  not  contribute  to  the  initial  tilt  errors,  but 
Figures  H- 1 6  and  H-17  show  that  specific  maneuvers  cause  large  variations 
in  these  standard  deviations  leading  to  the  maximum  percentage  of  error 
shown  in  Table  15.  This  table  shows  the  gyro  error  sources  contribute 
both  the  largest  percentage  of  tilt  errors  and  the  largest  percentage  of 
velocity  errors.  These  standard  deviations  of  east  and  north  velocity 
error  shown  in  Figures  H- 1 2  and  H-13,  unlike  the  accelerometer  induced 
errors,  have  prominent  variations  as  a  result  of  the  flight  trajectory. 
The  velocity  and  north  tilt  error  standard  deviations  reach  a  maximum  at 
the  final  time,  while  that  of  east  tilt  peaks  before  a  large  turn  cancels 
some  previously  built  up  system  errors. 

The  initial  conditions  resulted  in  greater  position  errors  than 
those  induced  by  the  gyro  errors  sources.  However,  for  a  longer  flight 
time,  integration  of  the  larger  gyro  induced  velocity  errors  would  result 
in  considerably  larger  position  errors. 

Gyro  error  sources  produced  about  the  same  amount  of  error  in  the 
vertical  channel  as  the  accelerometer  error  sources.  However,  this  is  a 
relatively  small  percentage  of  the  total  error. 

The  contribution  of  each  type  of  gyro  error  to  the  overall  error 
is  shown  in  Table  18.  Each  of  these  gyro  error  sources  will  now  be  dis¬ 
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Gyro  Bias.  Gyro  bias  errors  are  modeled  as  random  constants  in 
the  tilt  and  azimuth  differential  equations.  Therefore,  these  terms  do 
not  directly  couple  the  dynamics  of  the  flight  trajectory  into  the  error 
states.  This  type  of  error  source  causes  the  standard  deviations  of  the 
tilt  errors  to  grow  linearly  from  zero  to  the  maximum  percentage  shown  in 
Table  18.  Azimuth  error,  on  the  other  hand,  has  an  initial  alignment 
error  that  is  caused  by  gyro  bias.  Table  16  shows  that  this  is  the  major 
source  of  initial  azimuth  error.  The  standard  deviation  of  azimuth  error 
remains  constant  throughout  the  mission  and  accounts  for  about  half  of 
the  total  error  as  seen  in  Table  18. 

Azimuth  error,  multiplied  by  the  specific  forces  shown  in  the 
ninth  column  of  Figure  4b,  are  terms  in  the  velocity  error  differential 
equations.  Figures  H-19  and  H-20  show  the  resulting  variations  in  the 
east  and  north  velocity  standard  deviations.  Comparison  of  these  two 
plots  to  Figure  H-12  and  H-13  shows  that  this  is  the  major  source  of 
variation  in  the  standard  deviation  of  velocity  error,  but  does  not 
account  for  its  increasing  trend  or  variations  of  the  mean. 

As  is  the  case  with  most  of  the  other  error  sources,  the  standard 
deviation  of  the  gyro  bias  induced  position  error  increased  smoothly  to 
the  maximum  percentage  shown  in  Table  18.  Also,  slightly  more  variation 
was  apparent  in  the  vertical  channel  than  obtained  with  just  the  initial 
conditions,  but  this  was  insignificant  compared  to  the  overall  vertical 
error. 

Gyro  Scale  Factor  Error.  The  gyro  scale  factor  errors  multiplied 
by  angular  velocity  are  terms  in  the  tilt  and  azimuth  differential  error 
equations.  This  directly  couples  some  of  the  dynamics  of  the  flight 
trajectory  into  these  error  states  as  shown  in  Figures  H-21  through  H-23. 


The  standard  deviations  of  the  tilt  errors  grow  in  steps  until  they  re¬ 
present  about  one  fourth  of  the  total. 

From  the  relationship  established  in  Equation  (27),  it  is  seen 
that  the  scale  factor  error  multiplied  by  the  north  component  of  the 
earths  rotation  rate  contributes  to  the  initial  azimuth  error.  Table  16 
shows,  however,  that  this  is  a  small  percentage  of  the  overall  alignment 
error.  From  the  initial  standard  deviation,  as  shown  in  Figure  H-23,  the 
azimuth  error  increases  steadily,  but  has  several  minor  variations  due  to 
specific  maneuvers. 

The  tilt  and  azimuth  errors  multiplied  by  specific  force  are  terms 
in  the  velocity  differential  equations.  Integration  results  in  a  smooth 
standard  deviation  of  velocity  error  that  gradually  decreases  for  the  first 
two  thirds  of  the  mission  followed  by  a  slight  increase  during  the  final 
portion.  The  overall  result  is  about  the  same  percentage  of  velocity  and 
position  error  as  the  gyro  bias  produced  system  error. 

Gyro  Misalignment.  Misalignment  is  a  dominant  source  of  gyro  error. 
Table  18  shows,  however,  that  while  the  percentage  of  longitude  error  from 
this  source  is  large,  latitude  error  is  small.  This  difference  is  due  to 
the  predominant  north-south  orientation  of  the  flight  trajectory  shown  in 
Figure  43.  Inspection  of  the  fundamental  submatrix  shown  in  Figure  4i 
shows  that  for  a  northerly  heading  (Cey  =  Cnx  =  -Cuz  =  1),  the  terms 
multiplying  misalignment  errors  in  the  east  velocity  differential  equat¬ 
ion  are  ~&z  and  o)x  while  for  north  velocity  they  are  <dz  and  -u  (m  is  the 
angular  velocity  of  the  body  frame  with  respect  to  the  inertial  reference 
frame).  Since  roll  rate  is  a  factor  in  w  ,  this  term  is  generally  much 
higher  than  the  other  terms  resulting  in  more  east  velocity  and  longitude 
error. 
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This  directional  dependence  is  seen  explicitly  in  Figure  H-24. 

The  slope  of  the  standard  deviation  of  east  velocity  error  increases  as 
the  turn  to  a  north  heading  is  completed  after  400  seconds  of  flight  time. 
Figure  H-24  also  shows  along  with  Figure  H-25  that,  while  bias  induced 
error  accounted  for  most  of  the  variations  in  the  standard  deviations 
shown  in  Figures  H-12  and  H-13,  misalignment  error  causes  the  increasing 
trend. 

Figures  H-26  through  H-28  show  that  gyro  misalignments  produce 
abrupt  changes  in  the  tilt  and  azimuth  error  states  as  a  result  of  the 
flight  trajectory.  The  resulting  growth  in  the  standard  deviations  of 
these  error  states  leads  to  the  largest  percentage  of  overall  error  as 
shown  in  Table  18.  Figure  H-28  also  shows  that  gyro  misalignment  produces 
a  small  initial  azimuth  error.  This  is  error  resulting  from  sensing 
earth  rate  during  alignment. 

Gyro  Vlhite  Gaussian  Noise.  As  discussed  in  Section  II,  the  out¬ 
put  error  of  the  ring  laser  gyro  is  better  characterized  by  a  white 
Gaussian  noise  component  rather  than  by  exponentially  time-correlated 
noise  or  the  limit  thereof  for  long  correlation  time,  random  walk,  which 
is  typical  of  mechanical  gyros.  It  is  a  physically  wider  band  noise  pro¬ 
cess  in  laser  gyros  than  mechai ical  gyros.  This  noise  directly  drives 
the  tilt  and  azimuth  differential  error  equations  resulting  In  the  error 
shown  in  Figures  H-29  to  H-31 . 

The  standard  deviations  have,  as  expected,  an  increasing  trend, 
but  also  have  a  wavering  component.  This  is  due  to  the  simulation  program 
which  approximates  the  driving  noise  by  periodically  adding  noise  samples 
weighted  by  the  time  Interval  between  samples.  A  smaller  time  interval 
than  two  seconds  used  here  would  have  produced  less  variations.  Table  18 
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shows  that  white  Gaussian  noise  contributes  only  a  small  percentage  of 
the  overall  system  error.  The  standard  deviations  of  the  east  and  north 
velocity  errors  decrease  smoothly  from  their  initial  values  and  those  of 
latitude  and  longitude  gradually  Increase.  Slightly  more  oscillation  is 
apparent  in  the  vertical  channel  than  that  caused  by  just  the  initial 
conditions. 

Gyro  Scale  Factor  Nonlinearity.  The  nonlinearity  is  added  to  the 
scale  factor  error  as  shown  in  Equation  (13).  Table  18  shows  that  the 
nonlinear  contribution  has  almost  no  effect  on  the  growth  of  the  standard 
deviations  of  the  error  states.  However,  as  shown  in  Figures  H-32  through 
H-34,  the  ensemble  averages  of  the  tilt  error  states  vary  considerably  as 
a  result  of  the  dynamics  of  the  flight  profile.  The  cummulative  effect 
of  these  variations  is  a  slight  increase  in  the  mean  values  of  longitude 
and  east  velocity  error,  and  a  small  decrease  of  the  latitude  and  north 
velocity  error. 

The  small  effect  of  the  nonlinearities  on  the  error  standard  devi¬ 
ations  was  expected  since  the  flight  profile  was  not  specifically  con¬ 
structed  to  excite  this  error  source.  None  of  the  rolls  or  turns  per¬ 
formed  during  this  mission  were  designed  to  maintain  a  roll  rate  In  the 
nonlinear  region  shown  in  Figure  3.  The  nonlinear  error  source  was  only 
excited  while  the  roll  rate  was  in  transition  through  the  region.  An 
.  icrease  in  the  magnitude  of  the  scale  factor  nonlinearity  causes  con¬ 
siderable  deviation  of  the  mean,  but  no  detectable  change  in  the  growth 
of  the  standard  deviations. 

Barometric  Altimeter  Errors 

Barometric  altimeter  errors  are  the  dominant  error  source  for  the 
vertical  channel.  As  shown  in  Table  15,  both  the  altitude  and  up 
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velocity  percentages  of  total  error  are  two  orders  of  magnitude  larger 
than  that  obtained  from  any  other  error  source.  The  standard  deviations 
of  these  two  error  states  Is  virtually  identical  to  Figures  66  and  67. 
Although  this  error  is  significant,  a  relatively  small  amount  of  error  is 
coupled  into  the  horizontal  channels. 

Table  15  shows  that  barometric  errors  generate  more  latitude  error 
than  longitude  errors.  Again,  this  is  a  result  of  the  predominantly 
north-south  orientated  flight  profile  shown  in  Figure  43.  Inspection  of 
the  third  column  of  Figure  4b  shows  that  north  velocity,  through  the  re¬ 
lation  p„  =  -v  / R,  multiplied  by  altitude  error  is  a  factor  in  the  lat- 
g  n 

itude  error  differential  equation.  The  factor  pg  also  multiplies  the 
vertical  velocity  error  in  the  north  velocity  error  differential  equat¬ 
ion  resulting  in  more  north  velocity  error  than  that  in  the  east  direction. 
More  east  tilt  error  than  north  tilt  error  is  also  a  result  of  the 

factor  p  . 
e 

Gravity  Errors 

Gravity  error  sources,  like  the  accelerometer  errors,  contribute 
directly  to  the  initial  tilt  errors  and  indirectly  (through  the  first 
term  in  Equation  (27))  to  the  initial  azimuth  error.  The  relative  a- 
mount  of  this  initial  contribution  is  shown  in  Table  16. 

Although  gravity  errors  contribute  little  to  the  growth  of  the 
vertical  channel  standard  deviations,  they  do  cause  some  variation  in  the 
mean  values  of  altitude  and  up  velocity  error.  This  is  shown  in  Figures 
H-35  and  H-36.  Each  deflection  of  the  mean  corresponds  to  a  large  hori¬ 
zontal  turn.  Referring  back  to  Table  7  shows  a  large  difference  in  the 
standard  deviations  of  the  east-west  and  north-south  deflections  of 
gravity.  This  difference  would  cause  variations  in  system  error  with  a 
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change  in  the  direction  of  flight.  However,  the  higher  strength  of  the 
east  deflection  of  gravity  also  should  cause  more  east  velocity  and  long¬ 
itude  error,  but  Table  15  shows  just  the  opposite.  This  is  misleading 
because  the  entries  in  this  table  are  percentages  relative  to  the  error 
generated  by  all  sources.  More  total  longitude  and  east  velocity  errors 
were  generated  than  latitude  and  north  velocity  errors,  which  caused  the 
apparent  difference. 

Short  Alignment  Time 

The  inertial  reference  system  alignment  process  is  assumed  to 
occur  in  two  steps.  First,  the  computer  determines  local  level  by  sen¬ 
sing  the  gravity  vector  through  the  accelerometers.  Then  an  azimuth  re¬ 
ference  is  found  by  nulling  the  east  component  of  the  earth's  rotation 
rate  vector  as  sensed  by  the  gyros.  Since  the  gravity  vector  is  a  rela¬ 
tively  large  quantity  which  can  easily  be  detected  by  the  accelerometers, 
the  computer  can  rapidly  determine  the  transformation  necessary  for  a 
local  level  coordinate  frame.  However,  this  is  not  the  case  during  the 
second  portion  of  the  alignment.  The  earth  rate  vector  is  relatively 
small  which  makes  it  difficult  for  the  computer  to  determine  the  precise 
direction  of  zero  earth  rate  (the  east  direction).  The  longer  time  the 
computer  has  to  solve  the  problem,  the  more  accurate  the  azimuth  reference 
is. 

As  developed  in  Section  II,  a  long  alignment  has  tilt  errors 
directly  related  to  accelerometer  and  gravity  errors,  and  azimuth  error 
is  mostly  a  function  of  gyro  errors.  To  simulate  a  shorter  alignment, 
the  initial  azimuth  has  an  added  Gaussian  random  sample  of  3  arc  min 
standard  deviation. 

The  major  impact  of  the  short  alignment  time  is  shown  in 
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Figures  H-37  and  H-38.  These  variations  in  the  velocity  standard 
deviations  are  similar  to  those  caused  by  gyro  bias.  The  ninth  column 
in  Figure  4b  shows  that  the  azimuth  error  multiplied  by  specific  force 
is  a  component  in  the  velocity  differential  equations.  Changes  in 
these  specific  forces  as  a  result  of  high  g  turns  cause  the  steps  and 
peaks  shown  in  the  velocity  error  state  plots. 

The  relative  contribution  of  a  short  alignment  time  to  the  other 
error  states  is  shown  in  Table  15. 

Error  Budget  Conclusions 

Table  15  shows  that  gyro  error  sources  contribute  the  most  overall 
error  in  the  strapdown  inertial  reference  system  analyzed  here.  Although 
the  barometric  altimeter  errors  induce  the  most  error  in  the  vertical 
channel,  relatively  little  of  this  error  is  coupled  into  the  other  error 
states.  The  position  error  resulting  from  just  the  initial  conditions  is 
more  than  the  gyro  induced  position  error,  but  the  velocity  errors 
caused  by  gyro  error  sources  are  considerably  higher  than  those  from  the 
initial  conditions.  Therefore,  a  longer  time  of  flight  would  result  in 
more  gyro  induced  position  error  as  a  result  of  integration  of  the 
velocity  errors. 

Accelerometer  error  sources  in  general  did  not  couple  any  of  the 
dynamics  of  the  flight  trajectory  into  the  error  state  equation.  However, 
each  error  source  did  cause  a  difference  in  the  trend  of  the  standard 
deviations  of  the  error  states.  Misalignment  was  the  major  source  of 
accelerometer  induced  error.  It  was  not  only  the  largest  cause  of 
variation  of  the  standard  deviations  but  was  the  major  source  of  <oUial 
alignment  tilt  error. 

The  gyro  error  sources  cause  specific  maneuvers  in  the  flight 
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trajectory  to  be  reflected  by  changes  in  the  inertial  reference  system 
error.  Again,  misalignment  was  the  major  source  of  this  error.  This 
caused  rapid  variations  in  the  tilt  and  azimuth  error  states  and  intro¬ 
duced  an  increasing  trend  in  the  velocity  states.  Gyro  bias  caused  the 
most  initial  azimuth  alignment  error.  This  higher  error  coupled  trajec¬ 
tory  variations  into  the  velocity  error  states.  Scale  factor  errors  in¬ 
duced  variations  in  the  tilt  error  state,  but  not  to  the  extent  of  the 
gyro  misalignment  errors.  The  scale  factor  nonlinearity  introduced 
variation  in  the  error  state  mean  values  but  had  little  cummulative 
effect. 

Gravity  errors  did  make  a  small  contribution  to  the  system  error, 
as  seen  in  Table  15.  The  amount  of  this  error  varied  slightly  with  the 
direction  of  flight. 

For  the  time  of  flight  used  in  this  simulation,  a  short  alignment 
time  causes  a  system  error  that  is  comparable  to  gyro  bias  induced  error. 
This  is  because  each  causes  a  large  initial  azimuth  error. 
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VII.  Error  Analysis 

While  the  previous  section  was  concerned  with  determining  the  con¬ 
tribution  of  each  error  source  to  the  overall  system  error,  this  section 
investigates  the  specific  maneuvers  and  combinations  of  maneuvers  that 
particularly  excite  these  errors.  Since  gyro  errors  induced  the  most 
significant  trajectory-dependent  variations  in  the  error  states,  the 
plots  of  the  specific  contributions  of  each  of  these  error  sources,  in¬ 
cluded  in  Appendix  H,  will  be  used  to  help  determine  the  effects  of  each 
maneuver.  These  plots  are  a  result  of  the  "combat"  flight  profile  shown 
in  Figures  43  through  47, 

The  errors  generated  as  a  result  of  the  "training"  flight  profile 
will  then  be  compared  to  those  obtained  previously.  This  profile,  as 
shown  in  Figures  48  through  52,  is  the  same  time  length  as  the  "combat" 
flight  profile  but  is  made  up  of  20  segments  of  longer  duration  with 
more  sinusoidal  content  and  lower  accelerations. 

Error  Generated  from  Pitch  Changes 

The  pitch-up  initiated  at  t  =  2  seconds  produces  a  step  increase 
in  the  standard  deviation  of  north  tilt  error  (Figure  H-27)  and  a  smaller 
increase  in  that  of  east  tilt  error  (Figure  H-27).  Althougn  hese  changes 
do  not  dominate  over  the  initial  tilt  alignment  errors  (Figures  68  and 
69),  they  clearly  show  how  the  flight  trajectory  interacts  with  the  error 
sources.  With  the  aircraft  heading  north,  the  pitch-up  generates  an 
angular  rotation  vector  in  the  east  direction.  This  vector  is  multiplied 
by  scale  factor  error  to  become  a  term  in  the  east  tilt  differential 
error  equation  and  by  misalignment  error  to  become  a  term  in  the  north 
tilt  differential  equation.  More  north  tilt  error  is  generated  since 
misalignment  is  the  predominant  gyro  error  source.  Inspection  of 
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Figures  H-21  and  H-27  shows  that  level  off,  initiated  at  t  =  61.77  seconds, 
negated  most  of  the  previous  increase.  Although  the  pitch  down  was  made 
at  a  slower  rate,  it  was  in  exactly  the  opposite  direction  as  the  pitch 
up  and  of  longer  duration.  Had  the  aircraft  turned  90  degrees  before 
leveling  off,  the  scale  factor  and  misalignment  induced  errors  would 
be  in  opposite  channels  than  the  pitch-up  and  not  result  in  the  cancelation 
previously  observed. 

The  overall  result  of  these  two  maneuvers  is  that  during  the  climb 
some  tilt  errors  are  present  in  the  system.  These  tilt  errors,  multiplied 
by  specific  force,  are  terms  in  the  velocity  differential  equations. 
Therefore,  through  integration,  velocity  errors  and  subsequently  position 
errors  are  generated  as  a  result  of  the  climb.  Since  position  and  velocity 
errors  are  factors  in  the  tilt  differential  equations,  a  slight  increase 
in  overall  tilt  error  would  be  expected  in  spite  of  the  cancelling  effects 
of  these  two  maneuvers. 

The  above  analysis  shows  two  characteristics  of  the  system  error 
that  will  be  prevalent,  although  not  always  explicitly  stated,  throughout 
the  error  analysis.  First,  the  propagation  of  the  error  is  directly 
dependent  upon  the  direction  of  flight.  A  change  in  direction  between 
maneuvers  could  cause  either  reinforcement  or  candling  of  system  errors. 
Second,  although  variations  in  error  appear  to  have  a  cancelling  effect, 
the  overall  system  error,  through  integration  of  the  error  changes  Into 
the  other  error  states,  is  generally  higher. 

The  coupling  of  the  error  states  increases  considerably  when  the 
direction  of  flight  is  not  In  a  cardinal  direction  as  above.  At  time 
t  =  156  seconds,  while  the  aircraft  heading  is  315  degrees,  a  -25  degree 
pitch  change  is  initiated.  Figures  H-25  and  H-27  show  that  small  steps 
of  about  equal  amplitude  but  in  opposite  directions  are  caused  in  the 
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standard  deviations  of  the  tilt  error  states.  Even  smaller  variations 
result  from  the  scale  factor  errors  during  this  maneuver. 

Numerous  pitch  changes  in  succession  were  performed  in  the  time 
period  from  t  =  351  until  t  =  398  seconds.  A  180  degree  roll  was  made 
before  and  after  each  pitch  down  maneuver.  The  aircraft  was  on  a  heading 
of  205  degrees  during  these  maneuvers  so  both  roll  and  pitch  changes 
were  coupled  into  each  horizontal  channel.  Since  a  major  portion  of 
the  tilt  errors  are  due  to  the  roll  maneuvers,  the  specific  contributions 
from  the  changes  in  pitch  cannot  be  isolated  in  the  plots.  However, 
the  major  trend,  as  shown  in  Figures  H-16  and  H-17,  is  clear.  The  east 
tilt  error,  which  had  the  most  coordinate  frame  rotation  because  of  the 
180  degree  roll  maneuver,  had  a  standard  deviation  whicfy  oscillated. 

On  the  other  hand,  the  north  tilt  error,  without  the  reversals  in  the 
relationship  of  the  body  and  navigation  frame,  built  up  a  substantial 
standard  deviation  of  the  error.  The  specific  force  generated  by  these 

i 

pitch  maneuvers,  fu,  also  induced  small  variations  in  the  velocity  error 

states  shown  in  Figures  H- 19  and  H-20. 

Errors  Generated  from  Turns  / 

-  / 

The  first  turn,  initiated  at  t  =  76.77  seco/ids,  produced  prominent 

I 

changes  in  the  standard  deviations  of  the  error  states.  This  was  a  45 

/ 

degree  turn  which  started  from  a  north  heading./  The  tangential  accelera¬ 
tion,  therefore,  rotates  from  west  to  south-we$t.  From  Figure  4b,  it 
is  seen  that  west  specific  force,  -f  ,  multiplied  by  azimuth  error  is 
a  term  in  the  north  velocity  error  differential  equation.  Figure  H- 
20  shows  that  this  relationship  resulted  in  a  step  increase  in  this  standard 
deviation.  Little  variation  resulted  in  the  east  velocity  error  state 
since  most  of  the  specific  force  was  in  a  westerly  direction,  which 
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is  not  a  term  in  this  equation. 

Other  gyro  error  sources  also  contributed  some  variation  in  error 
during  this  first  turn.  Figure  H-22  shows  that  the  standard  deviation 
of  north  tilt  error  has  a  step  increase  resulting  from  the  scale  factor 
error  times  the  roll  rate  into  the  turn.  A  smaller  step,  due  to  the 
45  degree  change  in  heading,  in  the  opposite  direction  is  generated  from 
roll  out  at  the  turn's  completion.  East  tilt  error  standard  deviation 
(Figure  H-21),  on  the  other  hand,  has  just  one  increase  (following  a 
decrease  caused  by  a  pitch  maneuver)  as  a  result  of  the  angular  velocity 
of  the  turn  itself  reinforced  at  the  end  by  a  portion  of  the  roll  out 
vector.  The  scale  factor  nonlinearities  (Figures  H-32  and  H-33)  also 
caused  these  same  type  of  variations  in  the  mean  of  the  tilts. 

The  tilt  error  standard  deviations  due  to  gyro  misalignment  (Figures 
H-26  and  H-27)  have  greater  variations  and  effect  each  channel  in  the 
opposite  way  as  the  scale  factcr  errors.  A  large  step  in  the  standard 
deviation  of  east  tilt  error  resulted  from  the  roll  into  the  turn,  and 
a  smaller,  opposite  direction,  step  occurred  on  roll-out.  The  turn  caused 
a  step  increase  in  the  standard  deviation  of  north  tilt  error  which  was 
reinforced  by  a  portion  of  the  roll-out  vector. 

Figure  H-28  shows  that  the  angular  turn  rate  vector  also  increased 
the  azimuth  error  standard  deviation  as  a  result  of  misalignment. 

The  combined  effect  of  these  error  sources  did  cause  definite  varia¬ 
tions  in  the  standard  deviations  of  the  error  states  with  all  error  sources 
present  (Figures  64  through  70).  Results  similar  to  these,  but  in  the 
opposite  direction,  were  obtained  from  the  30  degree  turn  initiated 
at  t  =  169  seconds.  The  errors  generated  by  these  turns  were  relatively 
small  compared  to  those  induced  by  the  larger  turns. 
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Two  of  these  large  turns  were  performed  in  succession.  The  first 
was  a  6g,  270  degree  turn  initiated  at  t  =  197  seconds  and  ended  at 
t  =  235  seconds.  This  was  followed  by  a  7.33  g,  -100  degree  turn  initiated 
at  t  =  252  seconds  and  ended  at  t  =  271  seconds.  Figures  H-19  and  H- 
20  show  that  each  of  these  turns  induced  large  oscillations  in  the  velocity 
standard  deviations.  Although  the  -100  turn,  at  7.33  g,  is  generating 
more  specific  force  and  therefore  inducing  more  error  into  the  velocity 
differential  equations;  these  figures  show  a  smaller  peak  in  this  standard 
deviation  as  the  heading  passes  180  degrees.  This  shows  that  other  factors 
including  residual  system  errors  from  the  270  degree  turn  are  influencing 
the  overall  system  error. 

Both  of  these  large  turns  resulted  in  substantial  increases  in 
the  standard  deviations  of  azimuth  and  tilt  errors  as  a  result  of  the 
same  factors  discussed  previously.  However,  roll-out  from  the  -130  degree 
turn  at  t  =  271  seconds  produced  a  very  large  increase  in  the  standard 
deviation  of  north  tilt  error  as  a  result  of  gyro  misalignment  (Figure 
H-27).  The  roll-out  heading  of  75  degrees  caused  the  misalignment  error 
to  couple  most  of  the  roll  rate  vector  into  the  north  channel. 

This  same  effect  is  also  very  apparent  in  the  -400  degree  turn 
entered  at  t  =  737.5  seconds  with  roll-out  at  t  =  794  seconds.  The  air¬ 
craft  is  on  a  heading  of  175  degrees  when  the  turn  is  initiated.  Figure 
H-26  shows  a  large  variation  in  the  standard  deviation  of  east  tilt  error 
induced  by  misalignment  during  the  roll-in.  Again,  the  error  is  induced 
all  in  one  channel  because  the  aircraft  is  nearly  on  a  cardinal  heading. 
Also,  the  decrease  in  the  standard  deviation  is  a  result  of  residual 
system  system  error  from  previous  manuvers.  Specifically,  two  series 
of  turns,  with  a  net  result  of  a  180  degree  right  turn,  were  performed 
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just  before  the  -400  degree  turn.  The  roll-in  to  the  first  turn  of  the 
series  at  a  heading  of  355  degrees,  and  the  roll-out  of  the  last  turn 
at  a  heading  of  175  degrees  Induced  reinforcing  errors  into  the  east 
channel  as  a  result  of  misalignment.  Rolling  into  the  -400  degree  turn 
induced  the  negative  of  these  residual  errors  resulting  in  the  sharp 
drop  in  the  standard  deviation.  Rolling  out  of  the  -400  degree  turn 
at  a  heading  of  135  degrees  induced  little  change,  as  a  result  of  mis¬ 
alignment,  in  either  the  north  or  east  tilt  error  states. 

Errors  Generated  from  Rolls 

The  45  degree  roll  and  back  initiated  at  t  =  154  seconds  did  not 
reach  a  high  enough  roll  rate  (based  on  a  time  constant  of  0.5  seconds) 
and  was  not  of  long  enough  duration  to  have  Induced  any  perceptible  system 
errors.  On  the  other  hand,  the  180  degree  rolls  between  pitch  maneuvers 
generated  substantial  errors.  These  rolls,  on  a  heading  of  205  degrees, 
induced  large  changes  in  the  standard  deviations  of  the  tilt  error  states 
as  a  result  of  scale  factor  error  (Figures  H-21  and  H-22)  and  gyro  misalign 
ment  (Figures  H-26  and  H-27)  during  the  time  t  =  357  until  t  -  390  seconds. 
The  rolls  also  produced  deviations  in  the  mean  as  a  result  of  the  scale 
factor  nonlinearity  (Figures  H-32  and  H-33). 

The  360  degree  roll  initiated  at  t  =  859.5  seconds  produced  some 
very  interesting  results.  Figures  H-21  and  H-22  show  steps,  in  opposite 
directions,  in  the  standard  deviations  of  the  tilt  errors  as  a  result 
of  gyro  scale  factor  error.  However,  Figures  H-26  and  H-27  show  no  change 
in  these  error  states  from  gyro  misalignment  as  a  result  of  this  maneuver. 
At  this  particular  heading,  135  degrees,  and  as  a  result  of  the  residual 
system  errors,  the  errors  induced  by  misalignment  in  the  tilt  error  states 
cancel  each  other.  Referring  to  Figure  4i  shows  the  term  C  in  the 
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In  the  north  tilt 


east  tilt  differential  equation  and  the  term  Cnyox 
differential  equations.  But  at  a  heading  of  135  degrees,  these  elements 
of  the  direction  cosine  matrix  are  equal.  Figure  4b  shows  that  these 
two  differential  equations  are  coupled  by  the  term  -wu  times  the 
east  tilt  error.  It  is  this  coupling  with  the  same  driving  term 
and  the  proper  initial  conditions  that  produces  the  observed  cnacellation 
of  errors. 

Errors  Generated  by  Acceleration  Along  Fli.ght  Path 

The  only  isolated  occurrence  of  acceleration  along  the  flight 
path  occurs  from  t  =  81.77  until  t  =  104.1  seconds.  A  lg  forward 
acceleration  is  applied  at  a  heading  of  315  degrees.  Figure  4b  shows 
that  north  specific  force,  f  ,  is  a  term  in  the  east  velocity  differential 
equation  and  that  west  specific  force,  -f  ,  is  a  factor  in  the  north 
velocity  differential  equation.  Therefore,  it  would  normally  be 
expected  that  an  acceleration  midway  between  these  two  cardinal  directions 
would  induce  equal  variations  in  each  channel.  But,  Figures  H-19 
and  H-20  show  that  this  is  not  the  case.  A  ramp  is  induced  In  the 
standard  deviation  of  the  north  velocity  error  state,  but  no  change 
is  apparent  in  east  velocity  error.  The  last  maneuver,  a  -45  degree 
turn,  generated  mainly  west  specific  force.  Although  the  acceleration 
along  the  path  applies  equal  specific  force  to  each  channel,  in  the 
north  channel  it  reinforces  existing  error  while  in  the  east  channel 
the  induced  acceleration  error  itself  is  not  strong  enough  to  be 
predominant. 

Errors  Generated  Usi ng  the  T raini ng  FI i ght  Prof i les 

'  l 

The  emseinble  averages  of  the  error  states,  plus  and  minus  one 
standard  diviation,  resulting  from  propagating  all  the  error  sources 
over  the  training  flight  profile  are  shown 'in  Figures  71  through  79. 
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Figure  71.  Longitude  error  state  from  trnin.in  ;  profile 
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Figure  79.  Azimuth  error  state  from  trainiru;  profile 
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Comparison  of  these  plots  to  the  corresponding  plots  in  Figures  62 
through  70  resulting  from  the  combat  flight  profile  show,  with  the 
exception  of  the  north  velocity  error  state,  that  higher  standard 
deviations  of  the  errors  are  generated  using  the  combat  flight  trajectory. 
However,  the  standard  deviation  of  north  velocity  error  for  the  training 
flight  profile  did  remain  below  that  of  the  combat  profile  for  the 
first  two  thirds  of  the  mission.  Large  maneuvers  toward  the  end 
of  the  training  flight  profile  caused  the  observed  increase  in  velocity 
error. 

Inspection  of  altitude  and  up  velocity  error  plots  from  the 
training  profile  (Figures  75  and  76)  shows  lower  initial  peak  values 
occuring  at  a  later  time  than  those  induced  by  the  combat  flight 
profile  (Figures  66  and  67).  This  is  due  to  the  different  type  of 
climb  used  to  obtain  initial  cruise  altitude.  The  combat  profile 
simulates  an  afterburner  climb  to  gain  altitude  rapidly,  while  a 
gradual,  turning  climb  is  used  in  the  training  profile.  The  climbing 
turn,  unlike  the  straight  climb  in  the  combat  mission,  also  generates 
velocity  errors  (Figures  73  and  74).  The  errors  coupled  into  the 
east  velocity  differential  error  equation  by  north  and  up  specific 
forces  reinforce  each  other  and  produce  a  large  increase  in  the  standard 
deviation,  while  the  opposite  is  true  for  east  and  up  specific  forces 
in  the  north  velocity  differential  equations. 

The  tilt  error  states  shown  in  Figures  77  and  78  also  show 
some  variation  due  to  the  initial  turning  climb.  However,  these 
changes  appear  small  compared  to  the  large  variations  shown  in  north 
tilt  error  from  t  =  365  until  t  =  622  seconds.  During  this  time 
period,  a  3.5  g  loop  was  performed  by  pitching  up  on  a  heading  of 


205  degrees,  followed  by  a  lower,  negative  g  loop  on  the  same  heading. 

Since  this  results  in  a  predominately  east-west  oriented  angular 
rotation  vector,  most  of  the  error  is  generated  by  gyro  misalignment 
in  the  north  tilt  error  state  as  shown  in  standard  deviation  plotted 
in  Figure  78.  These  maneuvers  also  cause  large  variations  in  the 
east  velocity  error  state  as  a  result  of  the  combination  of  up  and 
north  specific  force  (Figure  73). 

The  remainder  of  the  maneuvers  in  the  training  flight  profile, 
based  on  the  previous  analysis  of  errors  generated  by  the  combat 
flight  profile,  produced  predictable  variations  in  the  error  states. 

The  sine  maneuvers,  initiated  at  t  =  195  seconds  and  t  =  689  seconds, 
induced  oscillatory  variations  in  the  standard  deviations  of  the 
error  states,  but  did  not  contribute  to  any  '.arge  increases  in  system 
error.  Figures  77  and  78  show  that  the  720  degree  roll,  initiated 
at  t  =  652  on  a  heading  of  65  degrees,  induced  steps  in  the  standard 
deviations  of  both  east  and  north  tilt  errors.  Considerable  variation 
was  induced  into  the  velocity,  tilt  and  azimuth  error  states  as  a 
result  of  the  -480  degree,  2.5  g  turn  initiated  at  t  =  261  seconds 
and,  as  expected,  even  more  error  was  induced  by  the  640  degree, 

4.5  g  turn  which  started  at  t  =  791  seconds. 

Error  Analysis  Conclusions 

Overall,  the  error  analysis  showed  that  a  maneuver  of  longer 
duration,  rather  than  high  g  loads,  induced  more  system  error.  Relatively 
low  acceleration  (1  or  2  g)  maneuvers  caused  little  change  in  the 
error  states,  but  a  maneuver  performed  at  two  different  higher  acceleration 
loads  (4.5  versus  6.5  g)  induced  about  the  same  amount  of  tilt  and 
azimuth  error  in  each  case.  The  magnitude  of  the  variation  in  the 
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velocity  error  states  does  directly  depend  on  the  amount  of  specific 
force  generated,  but  t he  cummulative  effect  depends  upon  the  length 
of  the  turn.  i 

Pitch  changes  generally  induced  the  most  error  into  the  channel 
more  closely  aligned  with  the  aircraft's  heading.  This  is  caused 
by  gyro  misalignment  interacting  with  the  pitch  angular  velocity 
vector  which  is  perpendicular  to  the  aircraft's  heading.  Scale  factor 
errors  do  induce  errors  in  the  opposite  channels  as  the  misalignment 
generated  errors,  but  in  most  cases  the  errors  resulting  from  misalignment 
are  larger.  Most  of  the  errors  generated  by  changes  in  pitch  directly 
effect  the  tilt  errors  as  a  result  of  the  pitch  angular  velocity 
vector;  however,  the  vertical  specific  force,  f  ,  also  induces  small 
variations  in  the  velocity  error  states.  Large,  relatively  high 
g  pitch  changes  induce  considerable  system  error,  but  a  subsequent 
pitch  change  in  the  opposite  direction  of  the  same  amount,  not  necessarily 
the  same  g  load,  cancels  most  of  this  error.  However,  a  change  in 
heading  or  attitude  (especially  a  180  degree  roll  or  turn)  between 
these  maneuvers  could,  instead,  cause  these  errors  to  reinforce  each 
other. 

Turns  generate  errors  from  three  different  events:  roll  into 
the  turn,  the  turn  itself,  and  roll  out  of  the  turn.  The  turns  are 
coordinated  so  that  some  heading  changes  do  occur  during  roll-in 
and  roll-out.  During  the  turn,  the  horizontal  specific  forces  that 
arc  generated  are  coupled  directly  into  the  velocity  differential 
equations  by  the  azimuth  error.  This  can  be  a  considerable  source 
of  system  error  depending  upon  the  amount  of  azimuth  error  and  the 
g  loads  of  the  turn.  A  180  degree  turn  from  one  cardinal  heading 
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to  another  induces  a  step  in  the  velocity  standard  deviation  of  the 
channel  perpendicular  to  the  original  heading  and  a  peak  in  that 
of  the  other  channels.  Rolls  into  and  out  of  the  turns,  done  at 
the  performance  limit  of  the  aircraft,  rather  than  the  turn  itself 
induce  the  most  tilt  errors.  A  90  degree  turn  from  a  cardinal  heading  ■* 
induces  about  the  same  amount  of  error  in  each  channel,  but  a  180 
degree  turn  induces  reinforcing  errors  in  one  channel  and  little 
error  in  the  other.  Most  error,  as  a  result  of  gyro  misalignment, 
is  induced  in  the  channel  perpendicular  to  the  heading  as  a  result 
of  the  rolls  into  and  out  of  the  turns.  Misalignment  also  causes 
a  ramp  in  the  standard  deviation  of  azimuth  error  during  each  turn. 

Isolating  the  roll  maneuver  itself  proved  to  be  very  beneficial. 

It  showed  that  maneuvers  that  are  not  performed  on  cardinal  headings 
(those  aligned  with  the  error  states)  do  not  necessarily  contribute 
proportional  errors  to  each  channel.  While  the  other  error  sources 
do  contribute  proportion  errors,  the  effects  of  the  major  error  source, 
misalignment,  can  be  cancelled  depending  upon  the  heading  being  flown 
and  the  previous  system  errors. 

Maneuvers  in  succession  that  generate  errors  in  the  same  direction 
produce  more  variation  in  the  standard  deviations  of  the  error  states 
than  when  each  maneuver  occurred  separately.  This  effect  was  shown 
in  several  instances.  In  one  case,  accelerating  along  the  flight 
path  45  degrees  between  cardinal  headings  only  produced  changes  in 
the  velocity  standard  deviations  of  the  one  channel.  This  was  a 
result  of  reinforcement  of  the  specific  force  generated  during  the 
previous  turn. 

The  second  flight  profile  did  not  generate  quite  as  much  overall 
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system  error  as  the  first  one.  However,  each  of  the  longer  duration 
maneuvers  did  produce  large  system  errors.  It  did  show  that  a  faster 
climb  produces  more  vertical  channel  error  and  that  sine  type  maneuvers 
produce  oscillatory  variations  in  the  error  states  but  do  not  contribute 
to  significant  growth  in  the  error  states.  This  profile  also  highlighted 
the  fact  that  the  effect  of  induced  errors  can  be  cancelled  by  performing 
the  same  maneuver  in  the  opposite  direction  but  not  necessarily  with 
the  same  acceleration  loads. 


VIII.  Conclusions  and  Re commend a ti ons 

Conclusions 

This  study  evolved  into  two  distinct  phases.  The  first  phase 
was  the  development  of  the  error  model  and  the  computer  simulation 
of  a  state-of-the-art  strapdown  inertial  reference  system,  while 
the  second  phase  was  an  analysis  of  the  errors  induced  into  this 
inertial  system  when  driven  over  a  highly  dynamic  trajectory. 

A  Monte  Carlo  simulation  was  chosen  in  preference  to  a  covariance 
analysis  so  that  computer  resources  could  be  used  more  efficiently. 

This  also  allowed  the  gyro  scale  factor  nonlinearity  to  be  included 
explicitly  in  the  error  model.  A  50  run  Monte  Carlo  simulation  produced 
almost  identical  results  as  a  covariance  analysis  and  ran  in  about 
the  same  amount  of  computer  time.  Fewer  than  50  runs  were  used  for 
problem  set  up  and  to  obtain  preliminary  results. 

The  Honeywell  GG1342  ring  laser  gyro  error  model  was  used  to 
represent  a  state-ot-the-art  gyro  since  it  was  recently  flight  tested 
in  the  A7-E.  The  Bell  Model  XI  accelerometer  error  model  was  chosen 
because  this  instrument  is  in  wide  use  today  and  has  better  error 
characteristics  than  the  accelerometer  currently  being  used  in  the 
Ring  Laser  Gyro  Navigator  (RLGN)  with  the  GG1342. 

Two  highly  dynamic  flight  profiles  were  constructed  from  representa 
tive  performance  characteristics  of  the  F15  in  its  air  superiority 
role.  The  more  intricate  "combat"  flight  profile  was  used  for  most 
of  the  error  analysis,  while  the  "training"  flight  profile  was  used 
for  comparison  of  the  overall  effects  of  two  different  scenarios. 

The  basic  result  obtained  from  the  error  budget  was  that  the 
gyro  error  sources  contributed  the  most  to  overall  system  error. 
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These  gyro  error  sources  also  directly  coupled  most  of  the  dynamics 
of  the  flight  trajectory  into  the  variations  of  the  system  error. 
Misalignment  was  the  major  source  of  error  for  both  the  gyros  and 
the  accelerometers.  Accelerometer  errors  caused  more  initial  alignment 
error  in  the  tilt  error  states  than  gravity  errors ,  while  gyro  errors 
and  short  alignment  times  were  responsible  for  most  of  the  initial 
alignment  errors  in  the  azimuth  error  states. 

t 

Analysis  of  the  errors  generated  by  propagating  the  error  model 
over  the  flight  trajectories  showed  that,  in  general,  a  long  duration 
medium  acceleration  maneuver  induced  more  system  error  than  a  series 
of  arbitrary  maneuvers  of  higher  accelerations.  Moreover,  maneuvers 
that  occur  in  succession  and  generate  reinforcing  errors  generally 
induce  more  system  error  then,  each  maneuver  seperately.  Also,  the 
same  maneuver  performed  in  opposite  directions  produces  less  overall 
errors  than  performing  the  maneuver  just  once.  Performance  of  a 
maneuver  between  cardinal  headings  does  not  necessarily  induce  proportion¬ 
al  errors  in  each  channel.  One  of  the  major  contributors  to  system 
error,  misalignment,  can  generate  errors  in  the  tilt  error  states 
that,  through  interaction  between  the  tilt  differential  error  equations, 
cancel  themselves  out.  This  depends  upon  the  heading  of  the  aircraft 
and  the  previous  system  errors. 

Recommendations 

The  investigation  done  here  was  an  initial  step  toward  gaining 
a  fundamental  knowledge  of  the  propagation  of  errors  through  a  strapdown 
inertial  reference  system  as  a  result  of  highly  dynamic  trajectories. 
Considerable  effort  was  expended  in  setting  up  the  complete  simulation 
package  and  incorporating  the  stochastic  error  models  arid  error  equations 
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into  the  simulation.  Since  the  general  simulation  program  used  here, 
SOFf,  is  very  well  documented,  and  the  subroutines  implementing  the 
strapdown  inertial  reference  system  error  model  are  essentially  self- 
documenting,  these  should  provide  a  solid  foundation  for  future  study 
in  this  area. 

The  flight  profile  generator,  PROFGEN,  has  some  definite  disadvant¬ 
ages.  Primarily,  it  does  not  model  the  dynamics  of  the  aircraft. 

For  highly  maneuverable  aircraft  this  causes  some  problems,  especially 
in  the  performance  of  roll  maneuvers.  Two  modifications  to  PROFGEN 
were  made,  one  to  include  a  roll -only  maneuver  and  another  to  provide 
a  realistic  roll  time  constant  for  turns  and  rolls,  but  more  changes 
need  to  be  made.  Out-of-plane  maneuvers  cannot  be  simulated  effectively 
since  changes  in  pitch,  rolls  and  turns  must  be  specified  in  seperate 
profile  segnents.  It  is  therefore  recommended  that  another  profile 
generator  be  considered  for  follow-on  study  in  this  area. 

This  study  did  identify  the  major  causes  of  system  error  for 
the  particular  gyro  and  accelerometer  model  used  here.  Further  study 
should  include  the  i ncorporation  of  other  ring  laser  gyro  and  accelero¬ 
meter  error  models  into  the  simulation  to  determine  if  these  errors 
are  typical  of  the  particular  models  chosen  or  of  a  state-of-the- 
art  model  in  general.  This  should  be  accompanied  by  a  sensitivity 
study  in  which  defining  parameters  are  increased  and  decreased. 

It  was  noted  during  this  investigation  that  particular  maneuvers 
reinforced  errors  while  others  cancelled  some  system  error.  More 
data  needs  to  be  generated  and  more  extensive  analysis  is  necessary 
in  order  to  provide  firm  guidelines  as  to  which  maneuvers  should 
be  employed  or  avoided  when  possible.  Also,  the  various  types  of 


. 

; 


.4 
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optimal  aiding  should  bo  explored  to  determine  the  reduction  of  system 
error  caused  by  each  in  this  highly  dynamic  environment. 
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Appendix  A 


SOFE :  A  Generalized  Digital  Simulation 

for  Optional  filter  Evaluation  (Ref  11?) 

SOFE  was  developed  as  an  efficient  general  purpose  simulation 
program  for  the  design  of  Kalman  filters.  Although  filter  design 
wa s  beyond  the  context  of  this  thesis,  SOFE  w as  used  for  both  the 
generation  of  a  Monte  Carlo  simulation  using  a  truth  model,  and  for 
covariance  propagation  of  the  error  state  equations  for  a  filter 
based  on  the  truth  model  and  having  no  input  measurements. 

The  basic  SOFE  program  contains  34  routines  which  perform  input/ 
output,  problem  setup,  run  setup,  numerical  integration,  and  run 
termination.  Nine  additional  subroutines  must  be  written  by  the 
user  of  the  program  to  specify  the  problem  to  be  simulated.  These 
nine  routines  supply  derivatives,  measurements,  truth  mooel  fluctuations, 
and  trajectory  data.  All  of  the  programming  was  set  up  to  be  efficient 
in  both  the  use  of  core  and  time.  This  was  done  by  dense  packing 
arrays  and  vectors  into  a  single  array,  using  singly  subscripted 
variables,  using  sparse  matrix  storage  techniques,  and  exploiting 
the  symmetric  properties  of  some  of  the  matrices. 

A  truth  model  in  SOFE  is  a  direct  implementation  of  the  error 
state  equations.  The  9  subroutines  and  data  required  to  develop 
the  truth  model  are  shown  in  Appendix  F.  Differential  equations 
for  the  model,  without  the  driving  noises,  are  propagated  through 
time  by  a  fifth  order  Runge-Kulta  integrator.  At  intervals  specified 
by  t ho  user  of  the  program,  the  integration  is  stopped  to  allow  for 
measurement  updates,  the  addition  of  noise  to  the  truth  model ,  feedback. 
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output,  or  whatever  is  specified  by  the  program  user.  A  subroutine, 

GAUSS,  is  provided  in  SOFE  for  generating  random  Gaussian  samples. 

SOFE  was  implemented  In  this  simulation  to  stop  integration  just 
for  the  addition  of  noise  to  the  truth  model  and  to  generate  output. 

No  measurements  or  feedback  were  used. 

The  filter  model  in  SOFE  is  implemented  by  specifying  both 
the  filter  error  state  equations  and  the  initial  covariance  matrix. 
Propagation  of  the  filter  error  state  equations  by  the  integrator 
is  much  the  same  as  the  propagation  of  the  homogeneous  truth  error 
state  equations.  However,  rather  than  periodically  adding  noise 
to  the  states,  the  covariance  of  the  error,  P(t),  is  also  propagated 
forward  in  time  by  numerically  integrating  the  equation 

P(t)  =  F(t)P(t)  +  P(t)F(t)T  +  Q(t)  (A-l) 

corresponding  to  the  state  equation  x(t)  =  F(t)x(t)  +  w(t),  where 

F(t)  =  fundamental  matrix 

Q(t)  =  white  driving  noise  matrix 

such  that  E{w(t)w^(t  +  t)}  =  Q ( t)6 (t ) 

The  9  subroutines  and  data  necessary  to  implement  a  filter  model  are 
shown  in  Appendix  G.  A  complete  explanation  of  Equation  (A-l)  and 
filter  models  can  be  found  in  Reference  8. 

Out  of  the  9  user  written  subroutines  available  in  SOFE,  only 
6  were  utilized  in  this  simulation.  U5R1N,  which  is  only  called 
once  by  SOFE  for  problem  initialization,  was  used  to  read  in  time 
constants  and  initial  standard  deviations  of  the  error  states.  Subroutine 
TRAJ  was  used  only  to  specify  some  constants,  since  an  external  flight 


139 


trajectory  was  generated.  Subroutines  XFDOT  and  XSDOT  specify  the 
homogeneous  differential  equations  of  the  filter  model  and  truth 
model.  These  two  subroutines  were  essentially  the  same  in  this  case 
since  a  full  order  filter  was  used.  Subroutine  SNOYS  is  used  in 
conjunction  with  the  truth  model.  It  is  called  at  intervals  to  inject 
noise  into  the  appropriate  states  to  simulate  the  driving  noise, 
w(t).  Subroutine  FCJGEN  is  used  to  specify  Equation  (A- 1 )  for  the 
propagation  of  the  covariance  matrix  associated  with  the  filter  model. 

All  of  these  subroutines,  except  USRIN,  are  called  at  the  beginning 
of  each  Monte  Carlo  run,  through  a  FORTRAN  ENTRY  statement,  to  initialize 
data  or  variables  particular  to  that  routine. 

In  addition  to  supplying  9  subroutines,  37  parameters  are  entered 
through  a  list  called  PRDATA  in  CDC  NAMELIST  FORMAT.  These  are  parameters 
which  remain  fixed  throughout  the  simulation.  They  specify  the  problem 
content,  control  input  and  output,  and  regulate  the  numerical  integration. 
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S  OF  II  SUBROUTINES  FOR  error  analysis 

SUBROUTINE  AMEND  {  IRUN  >  T  ,NF  ,N  S  ,  NXT  J  *  XF  ,  XS  ♦  XTR  A  J  J 
0  I  ME  NS  I  UN  XF ( NP  )  S ( NS )  ,  XTRA J ( NXT J ) 

RETURN 

ENTRY  AMENDE) 

RETURN 

END 


SUBROUTINE  ESTIXl  IRUN,T  ,  NF  ,  N  S  ,  NXT  J  ,  XF- ,  XS  ,  X  TR  A  J  *  NT  R  »  ?  =  ) 
DIMENSION  XFINF)tXS(NS)  *  X  T  R  A  J  (  NX  T  J  ) »  ?  F  (  N  T  R  ) 

RETURN 

ENTRY  ESTIXO 

R  ETURN 

END 

SUBROUTINE  F  QGE  N  {  IRU  N  ,  T  ,  NF  ,  NS  »  N  XT  J  .  XF  »  X  S  •  XTR  4  J  » 
KNZF,NZQ*Fi3) 

DIMENSION  XF(NF),XSINS)  ,XTRAJ(NXTJ)  ,F{NZF),Q(NZQ) 

RETURN 

ENTRY  FQGENO 

RETURN 

END 

SUBROUTINE  HRZ (  IRUN , T , N F , NS , NXT J , XF , X S ♦ XT R A J , N T R , P F , I  ME AS  * 
£M»H»RiZRES) 

DIMENSION  XF(NF),XS(NS>  ,H(NF> ,XTRAJ(NXTJ)  ,PF(NTR> 

RETURN 
ENTRY  HRZO 
RETURN 
ENO 

SUBROUTINE  S  NO  Y  S  <  I  »U  N  ,  T  ,  NT- ,  N  S  ,  NXT  J  ,  X  F  ,  XS  ,  X  TR  A  J  ) 

COMMON/ SMfJ  I  S/SO  WSO  163  )  *  SOWS  (  13  )  »  SD  WFO  (1) 

COMMON/ TCSYS/TAUS ( 3) ,01 ST ( A) 

C  OMMON/ T  R  J  COM/ RE  ,G  , 0  MEG  A  ,  F , R  K 1 » RK  2  ,  RK3 
DIMENSION  XF(NF) ,XS(NS) »XTRAJ(NXTJ) 


V  GND  =  S  Q RT I  X  TR  4  J IB ) *X T < A  J I  9  )  **2 ) 

DT-T-T3LO 

SRDT  =  SORTOT) 

STDGV-SDRSI l)*saOT 
XS(7)=XS(7)+GAUSS(O.B,STDEV) 

STDE  V=Sf)WS  I  2)  *  S  R  0  T 
X  S  (  B  )  =  X  S  (  B  )  ♦  G  AU  S  S  (  0 . 0  ,  S  T  0  E  V  } 

STD'  V  =  SOWS  (  3  )  A S y D T 
X  S ( D  )  =X S ( 9 )  *C AU S  S ( 0 . 0 , S  T  DE  V  ) 
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15  STOEV-SDWSl  4)*SRDT 

XS (4 )  =  XS ( 4) ♦GAUSSt O.O, S TOE  V) 

STOFV=SDwS( 5)*SRDT 
X S  (  5)=XS(  5)  ♦  r,AUS5(0.0,STOm 
STDl  V=SI)nS(  5  )*SRDT 
X  S  (  5  )  •-  X  $  {  'j )  +  G  A  U  S  S  (  0 . 0  »  S  T  D  F  V ) 

2  0  S  T  0  K  V  =  S  i>  w  s  {  7)  *  S  0  X  T  (  2  .  *0  T  /  T  AUS  (  1 )  ) 
XS(26)-«XS(26>*GAUSS(0.0.ST3EV) 

STOE  V=SDWS  (  5  )  *SO=>T  (2.  *0  T/TA'JS  (  2  )  ) 

XS(27)«XS(2  7)*-GAUSS(0*0,STDEV) 
ST0EV«S0WS*9)*SQRT(2.*DT/TAUS(3)  > 

XS( 23>=XS(2S) *GAUSS( 0.0,ST0FV) 

30  STOGV-SDMSC  10 ) *SUR T ( 2 . *DT* VGNO/D 1ST (  L)  ) 
XS(55)=XS(56)«-GAUS3(0.0,STDEV) 

4  0  STDfV=SDWS(  ll)*SQRT(2«*0T*VGND/DIST  (2)  ) 

XS(  55)  *XS  (5  3)  «-GAUSS(0.0,STDEV) 

STOEV=SDWS(  12  )*SGRT(  2 . *0T* VGND/D I  ST { 3 )  ) 

XS( 59)=XS(59)+GAUSS(D.0,STDEV) 

STDEV»SOWS(  13)*S0RT(  2.  *0T*VGND/D I S T  (  4)  ) 

XS(OOJ=XS(SO) *GAUSS( 0 .0 , STDEV  ) 

50  CONTINUE 

ENTRY  SNOYSO 
T  OLD  =  T 
RETURN 
END 

SUBROUTINE  TR  A  J  (.1  RUN  ,  T  ,  NF  ,  NS  ,  NXT  J  ,  XF  *  XS  »  XT  R  A  J  J 
C  OM  MON  /  T  R  J  C  ON  /  R  F;  ,  G  ,  3  M  E G  A  ,  E  ,  R K  1 ,  R  K  2  ,  RK 3 
DIMENSION  XF(NF  )  ,XS(NS) ,XTRAJ(NXTJ) 

DIMENSION  TITLE (20) 

DIMENSION  SEGLNTt  50) ♦ RE S TR T ( 5 0 J , I T JR N ( 50 ) , NR  A T H { 5 0 ) ,  P ACC ( 5 0 ) 
DIMENSION  T ACC (50) ,HE AD ( 50 ) , P I T ( 50 ) ♦ QTO < 50 ) . MODE ( 50 ) 
DIMENSION  E  R  RQR ( 5  0 ) , HM A  X { 50) »HMIN( 50) 

RETURN 
ENTRY  TRAJO 

READ  (3)  TITLE, TODAY, CLOCK 

READ  (3)  IPR03,NSEGT,LLMECH,TSTART,VTO,PHEADO,?ITO, 

£  ALFA0,LAT3,L0N0, ALTO, I PRNT , I R I TE , I  PLOT , ROLR A T , LUN I T 
READ  (3)  SEGLNT,RESTP.  T«ITURN,  N  PATH, P  ACC, TACC,  HEAD, 

£  P  I  T  ,D.TO  ,  M3  DF. ,  ?  R  R  OR  ,  HM  4  X  ,  HM  I N 
IF  ( IRUN.GT.  I)  GO  TO  10 

CALL  PAG CON ( 44, 1 ) 

WRITE  (5,100)  T  ITLE, TODAY, CLOCK 

100  FORMAT  (  1X,7HTITLF.:  ,  20  A  4/ IX  ,  7HD  ATE  :  ,  A  10  /  IX  ,  7  HT I  ME  :  ,A10) 

PRINT*,"  I P  R  0  3  J  "  ,  IP R 0  3 
PRINT*,"  NSEC. T:  ",NSEGT 
PRINT*,"  L . ME CH : " , LL MEC H 
PRINT*,"  TSTART  :",TST4RT 
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MINT**"  VTH :  " ,  V  T  0 

p  p  i  nt*  , "  p  h  c  a  o o : ", phe ado 

PRINT*,"  P  I  TCHl) : " » P I  TO 
PRINT*,"  A .FAT:  "  ,  A  L  F  A  0 
PRINT*,"  IPRNT:  "  ,  I  PR  NT 
P  p  I  M  T  *  ,  "  I  I  TF  :  "  » l  R  I  T  E 
PRINT*,"  I  PLOT:  ",IPLOT 
PRINT*,"  ?.  DLRAT  :  ",  ROLRAT 
PRINT*,"  LJNIT:  ".LIJNIT 
PRINT*,"  " 

PRINT*,"  S  =  GLNT :  ", SEGLNT 
PRINT*,"  RESTRT:",RE5TRT 
PRINT*,"  ITURN:  ",ITURN 
PRINT*,"  MPATH:  ",NPATH 
PRINT*,"  P \ C  C :  "  ,  P  A  C  C 

PRINT*,"  TACC:  "  ,  T  ACC 
PRINT*,"  HEAD:  " , HEAD 
PRINT*,"  PITCH:  ",PIT 
PRINT*,"  DTD:  "  ,  DTD 

PRINT*,"  MODE:  ",HDOe 
PRINT*,"  ERROR:  ", ERROR 
PRINT*,"  H  N  A  X :  "  ,  HM  A  X 

PRINT*,"  HNIN:  ",HMIN 
10  CONTINUE 

RE=20925640. 

G=32. 0381576 
0  MEG  A  =  .  7 2 9 2 1 1 5 1 E -4 

E-l.  7293.3 

C  STANDARD  K  VALUES  ARE  Kl«3.6-2»  K2=3.E-4,  K3=-l.E-6 

C  OPTIMAL  K  VALUES  ARE  Kl=1.003,  K2=4.17E-3,  K3=4.39E-6 

RK1-3.E-2 
P.K2«3.t=-4 
9X3-1. 5-6 
RETURN 
END 

SUBROUTINE  USRIN 

COMMON/ SNOT  S/S0WSO(60  )  ,  SON'S!  .13  )  ,SOHFO  ( 1 ) 
COMMON/TCSrS/TAUSO)  ,01  ST(  4) 

NAMELIST/INS/TA  US, GIST, SD'RSD, SOWS, SDrfFO 

CALL  PAGCON { 60, 1 ) 

PRINT*,"  X ( 1 )  EAST  LONGITUDE" 

PRINT*,"  X ( 2 )  NORTH  LATITUDE" 

PRINT*,"  X ( 3 )  ALTITUDE  (UP)" 

PRINT*,"  XI 4)  EAST  VELOCITY" 

PRINT*,"  X(^)  NORTH  VELOCITY" 
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PRINT* 

II 

VERTICAL  VELOCITY" 

P  R  I  'IT* 

II 

xi  n 

EAST  ATTITUDE 

ft 

PRINT* 

II 

X  (  1  ) 

NOR 

TH  ATTITUDE 

It 

PRINT* 

II 

X  <  9  ) 

UP 

ATTITUDE 

11 

PRINT* 

II 

X  {  10) 

INT 

FGRAl  OF  VERTICAL  CHANNEL  ERROR 

• 

PRINT* 

II 

X  (  U  ) 

X 

GYRO  t)P  I  c  T  RATE  " 

PRINT* 

It 

X  (  12) 

Y 

GYRO  DRIFT  RATE  " 

PRINT* 

If 

X  (  t  3  ) 

Z 

GYRO  DRIFT  RATE  " 

PRINT* 

II 

X(  14  ) 

X 

GYRO  SCALE  FACTOR  " 

PRINT* 

ft 

X  (  1 5  ) 

Y 

GYRO  SCALE  FACTOR  " 

PRINT* 

If 

X  (  1  6  ) 

Z 

GYRO  SCALE  FACTOR  " 

PRINT* 

« I 

X(  17) 

X 

GYRO  MISALIGN 

ABOUT 

Y  " 

*  ft  INT* 

f» 

XI  I  3 ) 

X 

GYRO  MISALIGN 

ABOUT 

Z  " 

PRINT* 

If 

X  (  1 9 ) 

Y 

GYRO  MISALIGN 

ABOUT 

X  " 

PRINT* 

II 

X  (  2  0  ) 

Y 

GYRO  MISALIGN 

ABOUT 

Z  " 

PRINT* 

II 

X  (  2. 1  ) 

Z 

GYRO  MISALIGN 

A  BOUT 

X  " 

PRINT* 

tl 

X  (  2  2  ) 

Z 

GYRO  MISALIGN 

ABOUT 

Y  " 

o  a  I mt* 

11 

X  (  2  3  ) 

X 

accelerometer 

e  r  a  s 

ti 

P  R INT* 

II 

<  (  2  4  ) 

Y 

ACCELEROMETER 

31  AS 

ti 

P  R I  NT* 

M 

X  (  2  5  ) 

Z 

ACCELEROMETER 

BIAS 

ii 

P  R  I N  T  * 

1* 

X(  26) 

X 

ACCEL  EROMETER 

60  SEC  BIAS  " 

P  R I  NT* 

II 

X  (  2  7) 

Y 

ACCELEROMETER 

60  SEC  BIAS  " 

PRINT* 

II 

X(  28  ) 

Z 

accelerometer 

60  SE 

o 

C2> 

> 

<Si 

PRINT* 

n 

X(  29) 

X 

accelerometer 

INPUT 

QUADRATIC  (  X 

AXIS) 

»t 

P  PINT* 

tl 

XI  30) 

Y 

ACCELEROMETER 

CROSS 

QUADRATIC  (X 

AXIS) 

II 

PRINT* 

»t 

X<  31) 

Z 

ACCELEROMETER 

CROSS 

QUADRATIC  (X 

AXIS) 

11 

P  PINT* 

it 

X  (  3  2) 

X 

ACCELEROMETER 

CROSS 

QUADRATIC  (Y 

AXIS) 

II 

PRINT* 

it 

X(  33) 

Y 

ACCELEROMETER 

INPUT 

QUADRATIC  (Y 

AXIS  ) 

II 

P  PINT* 

M 

X(  34) 

Z 

ACCELEROMETER 

CROSS 

QUADRATIC  (Y 

AXIS) 

If 

PRINT* 

it 

X(  35  ) 

X 

ACCELEROMETER 

CROSS 

QUADRATIC  (Z 

AXIS) 

II 

PR  INT* 

•• 

XI  36) 

Y 

ACCELEROMETER 

CROSS 

QUADRATIC  (Z 

AXIS) 

tl 

PR  INT* 

it 

X  (  3  7  ) 

Z 

ACCELEROMETER 

INPUT 

QUADRATIC  (Z 

AXIS) 

»l 

PRINT* 

it 

X(  33  ) 

X 

ACCELEROMETER 

CROSS 

SCALE  FACTOR 

(  X,  Y) 

rt 

PRINT* 

n 

X(  39) 

Y 

ACCELEROMETER 

CROSS 

SCALE  FACTOR 

(XtY) 

r» 

PR INT* 

»i 

X(  40) 

Z 

ACCELEROMETER 

CROS  S 

SCALE  FACTOR 

(  X  »  Y  ) 

if 

PRINT* 

M 

X(  41 ) 

X 

ACCELEROMETER 

CRQS  S 

SCALE  FACTOR 

(  X,  Z) 

n 

P  PINT* 

ii 

X  (  4  2  ) 

Y 

ACCELEROMETER 

CROSS 

SCALE  FACTOR 

(  X  ,  Z  ) 

♦i 

PRINT* 

ii 

X(  43) 

Z 

ACCELEROMETER 

CROSS 

SCALE  FACTOR 

(X,Z) 

it 

P  R I  NT* 

n 

X  (  4  4  ) 

X 

ACCELEROMETER 

CROSS 

SCALE  FACTOR 

(  Y  »  Z  ) 

if 

PRINT* 

ii 

X(  45  ) 

Y 

4CCELERQ METER 

CROSS 

SCALE  FACTOR 

(  Y,Z) 

ti 

PRINT* 

» 

X(  46  ) 

7. 

ACCELEROMETER 

CROSS 

SCALE  FACTOR 

(Y,Z) 

ii 

PRINT* 

•i 

X  (47) 

X 

ACCELEROMETER 

SCALE 

FACTOR  " 

P  S INT* 

ii 

X  (  4  3  ) 

Y 

ACCELEROMETER 

SCALE 

FACTOR  " 

PRINT* 

it 

XC  49  ) 

Z 

ACCELEROMETER 

SCALE 

FACTOR  " 

PRINT* 

n 

X  (  5  0  > 

X 

ACCELEROMETER 

MI  SAL 

IGN  ABOUT  Y  " 

PRINT* 

if 

X  (  5  1  ) 

X 

ACCELEROMETER 

MISALIGN  A  3  OUT  Z  " 

PRINT* 

ii 

X  (  5  2  ) 

Y 

ACCELEROMETER 

.M  IS  AL 

IGN  ABOUT  X  " 

PRINT* 

»i 

X  (53) 

Y 

ACCEL FROMETFR 

MISALIGN  ABOUT  Z  " 

PRINT* 

n 

X  (  5  4  ) 

Z 

ACCELEROMETER 

K  I  S  A  L 

IGN  ABOUT  X  " 

PRINT* 

ii 

<  <  55  ) 

/ 

ACCELEROMETER 

MISALIGN  ABOUT  Y  " 

PRINT* 

i» 

X(  56  ) 

BAR  PRES  " 
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PRINT**"  X(r>7) 
PRINT*,"  X  I  S  I  > 
PRINT*,"  X ( 5  9 ) 
PRINT*,"  X ( 60 ) 


BAR  SCALE  FACTOR  " 

{  AST  0  i  F  L  G  R  A  V  l  T  V  " 
NOR  [I  p  F  L  GRAVITY  " 
GRAVITY  ANOMALY  " 


100 


T  A  U  S  ,  0 1 S  T  ,  SDVSO»SOWS»SI)WFO 


R  E A  0 ( 6 , INS) 

WRITE! 6,  LOO) 

R  F  T  U  R  M 

FORMAT! " L"5 ( /)T10" TRUTH  MODEL  DATA-BASE  FROM 
ENAMEL  I  ST  INS:  " 

S//T15"T  IMS  CONSTANTS,  TAUS  " 

S/T20,3G14.7  ^ 

E//T  IS "CORRELATION  DISTANCE,  D1ST 

E/T20,',GU.7 
g//T15"S0WSJ" 
f./lG!/T20,6GlA.7) 
f.  /  /  T  1  5  "  3  D  W  S  " 

f,  /  2</T20,6GL<*.7)/T20,Gl/».7 

6  /  / T 1 S" S  D WF  3  " 

F./T20, 1G14. 7) 

END 


SUBROUTINE  XFi)OT(IRUN,T  ,NF,NS,NXTJ,XF,XS,XTRAJ,NTR,P 
COM MON/ TR J COM /RE ,G, OMEGA, 5 ,RK1,RK2,RK3 

C0HM0N/SNQIS/SDWS0(60),S0WS(13),S0WFU(1) 

DIMENSION  XF(NF)  ,XD3T(NF)  ,XS<  NS)  , XTRAJ  (NXTJ)  ,PMNTR) 

X  DO  T ( I ) *0 • 

RETURN 


ENTRY  XFOOTO 


X F {  1 ) =0  « 

RETURN 

END 


SUBROUTINE  XSOQT(IRUN,T , NF»N$,NXTJ«XF«XS,XTRAJ,XDOT) 
DIMENSION  XF(NF  )  ,  X  S  (  N  S  )  , XTRAJ (NXTJ ) ,XDOT ( NS) 


COMMON/TC SYS/ TAUS! 3) *DI ST! A) 

COMMON/ SNO I  S/SO  WSO ( 60 ) , SDKS! 13) ,SDWFOC L) 
COMMON/TR  JC  01/ RE ,G,OM£G  A , E  »RK1 ,RX2 ,RK3 

C  16  TRAJECTORY  INPUTS  FROM  PROFGEN 

R  LAT  =  XTR A J !  1) 

RLON  =  X  TRAJ ( 2 ) 

ALPHA=XTSAJ(3) 

ALT-XTRAJ(A) 

ROL* XTRAJ < 5 ) 

P IT” XTRAJ! 6  ) 

YAW-XT? A J ( 7  > 

V  N  =  X  T  R  A  J  (  B  ) 

VE --XTRAJ ! 0 ) 


, XDOT) 
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VU=XTRAJ( ID ) 

FN=XTRA J(  11 > 

FE  -  -XTRAJ  (  L  2  ) 

FU=XTRA J( L3) 

OROL=XTRAJ (  1 A  > 

DPI  T«XT.<AJ(  15) 

D  YAW=X  TRA  J  (  L?> ) 

VGNO=SORT(  VN**2*Vt**2  ) 
SLAT=SIN(R_AT) 

CL  AT -COS ( FLAT) 
TLAT=SLAT/CLAT 
OMEGAN*OME3 A*CIAT 
0  ME  OAUaOMEO A*SLAT 
S  X  =  S I N ( RQL ) 

expense vol) 

SY=SIN(PIT) 

CY=COS (PIT) 

S Z=S I N { YAW) 

CZ-CCJS  ( YAW  ) 

S  A  =  S  I N  (  ALPHA) 

CA=COS (ALPHA  ) 

SLON-SINI ULON) 
CLQN=COS(RLON) 


C  RHO  IS  THE  ANGJLAR  VELOCITY  OF  THE  NAV  FRAME  WRT  EARTH 

RHOr.*-VN/9E 

RHQN=VE/RE 

RHOU-VE*TLAT/RE 

C  WE-VN-WU  ARE  THE  ANGULAR  VELOCITY  OF  THE  NAV  FRAME  WRT 
C  INERTIAL  FRAME  COORD  INAT I ZEO  IN  THE  NAV  FRAME  (E-N-U) 


WE-RHOE 

WN«RHON*OMEGAN 
W  U  =  R  H  0  U  ♦  0  M  E  G  A  U 

C  COMPONENTS  OF  THE  PINSON  MATRIX 

R  KZ-VU/RE 
RLAT2a2«*R‘_AT 

FA2  =  2.’S‘(OM;GAN*VN«-OMEGAU*VU}*RHON:!tVN/(CLAT**2) 

F A3-RHOU* RH 06 ♦RHON*R<Z 

F  A#,a-RHQ5*TLAT-RKZ 

F52=-2.  ■S'O^EGAN^VE-RHON^VE/CLAT^’S'Z 

F  ■53  =  RHON*R HOU-RHOF^RK Z 

F  b  3  =  2  .  *  G  /  ?  E  -  R  H  )  N  *  *  2  -  R  H  ( )  E  *  *  2 

F  •?  2  -  W  N  ♦  R  H  0  U  Y  T  L  A  T 

C  TRANSFORMATION  FROM  NAV  FRAME  (E-N-U)  TO  BODY  FRAME  (X-r'-Z) 
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CX!:’SZ*CY 

CXN«CZ*CY 

CXU’SY 

CYt'»SZ*SY*SX  +  CZ*CX 
C  Y  N  -  C  7  R  S  Y  S  X  -  S  Z  *  C  X 
CYU --CY*SX 
CZtv*-CZ*SX*S7*SY*CX 
CZN  =  CZ*SY<‘CX  +  SZ>!‘SX 
CZU=-CY*CX 

C  TRANSFORMATION  FROM  BODY  FRAME  (  X-Y-Z  )  TO  NAV  FRAME  (6-N-U) 

C  E  X  =  C  X  E 
C  L:  Y  =  C  Y  E 
C  E  Z  3  C  Z  F: 

C  N  X  -  C  X  N 
C  N  Y  =  C  Y  N 
C  N  Z  =  C  Z  N 
CUX^CXU 
CUY=CYU 
CU7=CZU 

C  SPECIFIC  FORCE  IN  THE  BODY  FRAME 

FX=CXN*FN*CXE*FE+CXU*FU 

FY-CYN^FN+CYE^FF+CYUAFU 

FZ-CZN*FN+CZE+FE+CZU*FJ 

C  ANGULAR  VELOCITY  OF  BODY  FRAME  WRT  INERTIAL  FRAME 
C  COORD  INATI ZED  IN  THE  BODY  FRAME 


WX=CXE*ME  +  ;.XW’HN  +  CXU*WU  +  OROL 
wy-cye*we«-:yn**n*cyj*wu+dpit 

HZ-CZE*ME+CZN*WN+CZU*HU*OYAH 

C  INSERT  2.5  PPM  SCALE  FACTOR  NONLINEARITY 

XSFNL-0.0 
YSFHL-0.0 
ZSFNL-0.0 
AWX=ABS ( WX ) 

A«Y=A5S ( WY ) 

A  M  Z  *  A  8  S  (  W  Z  ) 

IF( ( AWX.GT.2 . AA3A609) .OR  .  ( AWX.LT.  1. 3962o3 A)  )  GO  TO  2D 
XSFNL=9.  1 1997E-#»*WX**2-3 .50  1B9E-5  *  A  WX  ♦  3  .  1 11656-5 

2D  I F < ( AWY.GT .2 . A43A60O) .or  .  ( AWY.LT .  1.396263  A ) )  GO  TO  JO 

Y  S  r  N  L  -  9 . 1 1  9  9  7  E  -  6  *  -1  Y  $  $  2  -  3 . 5  0 1 8  9E -6  *  A  W  Y  +  3  .  I  L  1 66  G -5 
30  I  F  (  (  A  W  7. .  GT  .  2  •  A  A  3  A  699  )  .  0  ?  .  f  A  WZ  .  L  T  .  1 . 396  26  3  A  )  )  GO  TO  AO 

7  SFNL39.  U9  97E-6*  WZ*  *2-3 . 50 1 B9E -5 « A W Z  *  .3  .  I  I  166F  -5 
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40  CONTINUE 


XDOT  t  l )  -  XS  f  2  1  *3HnU/CL.U-XS  (3)  *RH0N/{  RL:*CLAn+XS(4)/ 
E(RF*CLAT) 

XDOT  C  2  )  «XS  U)  *RHn=  /R  E*  XS  I  5  )  /  RE 

XDOT  (  i  )  *-R<  l*X3  (  3  )  *XS  (  6  )  *XS<  56)  *o.K  UXS  (57)  «RK1*ALT 

X  0 1)  T  {  4  )  «  X  S  (  2  )  *  F  4  2  +  X  S  C  3  )*  F  4  3  ♦  X  S  (  4  }  *  F  4  4  +  X  S  (  5  )  *  (  A  J  +  0 .1 E  G  AU  ) 
£  -  X  S  (  b  )  *  (  W  N  *•  0  M  £  r,  A  N )  -X  S  (  8)  *  F  U  ♦  X  S  <  9  )  *  F  N 
£+XS(2  3)*CFX  +  XS(24)*C::Y*-XS(25)15:C(:Z 
S>XS(  2f>)*CcX»XS(  27)  *CEY*XS(?fl  )*CEZ 

£  +  XS  (  29)  *CEX*FX*FX  +  XS  (30  )  *CEY*FX*FX«-  XS  (  31)  *CF.Z  *F  X*  F  X 
f.  ♦  XS  t  32  )  $CFX*FY*FY*XS  (  33  )YCcY<,FY''!FY*-XS(34)  $  C  E  Z  F  Y  *  F  Y 
£.♦  XS  (  3  5  )  *CEX*F7*FZ  +  XS  (  3  4  )  *  C  F  Y  *  F  7  *  F  Z  MS  (  37  )  « C !5 Z  F  Z*FZ 
£*XS  (13  )  *CEX*FX*FY+XS  <  3:M  *CFY*FX  *FYMS  (  40  )  *C F Z * F X  * F Y 
SMS  (  41 )  *CF:X*r-X*F  7-i-XS  (  4?  )  *CFY*FX*F  ZMS  (  4  3  )  *CEZ*FX*FZ 
f.  +  XS  (  4  4  )  *CF.X«F  Y*F  Z  MS  (  4 ‘5  )  *C  F.Y<  F  Y*F  Z  *  XS  (  46  )  *Ci::Z*F  Y*FZ 
SMS  (4?  )  *C(:X*FXMS  (  43  )  *C.tY*F-YMS  (<*9  )  *CF;Z*F  Z 
£-XS  <  50)  ^CEX^FZMSt  51)  *CFX*FYMS  <52  )  *CEY *FZ 
£-XS ( 53) *CEY*FX-XS(54) *CEZ*FY  +  XS l 55) *CEZ*FX  +  XS  <  58) 

X  DOT ( 5 ) =XS (  2)*F52+XS(3)*FS3-XS(4)*2«*WU-XS(5)+?KZ 
E*XS(6)*RH0=*XS(7)*FU-XS (9)*FE 
SMS  (  23)  *CNX+X3(  2  4)*CNYMS  (25)*CNZ 
e  +  XS(  26)  *CNX+XS(27)  *CNYMS  (  28  )  *CNZ 

SMS (29) *CNX*FX*FXMS ( 30 ) * CMY*F X *F X+ X S ( 3 1 > *CNZ*FX*FX 
SMS  {  32  )  *CNX-'5[FY*:rY»XS  (  33  )’!=CNY<IFY$FYM3  (  34)  ^CSZ^FY^FY 
SMS(35)*CNX*FZ<'FZMS(3(>)*CNY*FZ*!:2MS(37)<!CNZ*FZ’!=FZ 
£MS<33)*CNX*FX<'FYMS<39)*CMY<‘FX*FYMS(40)*C'tZ*M<‘FY 

£  +  X5  (  41  )  ^CNX^FX^FZ  +  XS  (  4 ?  )  *CNY<:FX*FZMS  (  43  )  ^CNZ^FX^FZ 
SMS  (  44)  sCNX^FY^FZMS  (  45  )  *CNY*FY*FZMS  (  46  )  * CN Z * F Y* F Z 
SMS  { 7  1  $CNX*FXMS(  4  8)  ^CNY^FYMS  (4  9)  *C  N  Z  Y  F  Z 
£-XS(  50)  *CNX*FZMS(  51)*CNX  +  FY*XS  (52  )  *CNY*FZ 
£-XS(  53)*CNY#FX-XS(54)*CN7*FYMS<55  >*CNZ*FX  +  XS(  59) 

XD0T(6)=-XS  (2  >*2«<,0M6GAU,i‘VE  +  XS(3)*(  F63-RK2)MS<  4  )  $  2  •  *  W  N 
£-XS  (  5)  S2MRHGF.  -  XS(  7)  *F  N  +  X  S  (8  )  *  F  E  — X  S  (  10 ) 

£  M  S  (  2  3  ) *CUXMS (  24)  *CUYMS(  25  )*CUZ 
EMS(26)  *CUXMS  <  2  7)  *C'JYMS  <  28  )  ^ C U Z 

£MS  (  29)  *CUX*FX*FXMS  (  3  0  )  *CUY*FX*FXM$  (  3 1 )  *C'JZ  *F X*  FX 
EMS  (32  )  *CUX*FY*FYMS  (33  )  *CUY<=FY*FYMS  {  34  )  ^CUZ^FYYFY 
£M${35)*C'JX*FZ*FZMS(35  ) * CUY *F  Z * F Z* X S  <  37  5  *CJZ *F  Z* F  l 
EMS  (  38)  *CUX*FX*r-YMS  (  39)  SCUY*FX*FYMS  (  40  )  ^CUZ^X^FY 
£♦  XS  (  41 )  *CUX*M*FZMS{  42  )*CUY*FX*F  ZMS  (43)  *CUZ*FX*FZ 
£  ♦  X  S  (  44  )  *  CD  X  *  F  Y*  F  Z  v  X  S  (  4  5  )  *  C  U  Y  *F  Y *  F  Z  +  X  S  <  4  6  )  *C  UZ  *  c  Y  *F  Z 
£♦  XS  (  4  n  *CUX*FXM$  (48)  *C'JY*FYM5  (49  ) *CUZ*FZ 
E-XS  (50)  *C’JX*FZMS(  51)  *C'JXYFYMS  (52  >  *CUY*F  Z 
£-XS  (53  )*0'JY*FX-XS  (  54  )  *CUZ  *FY*  XS  (  50  )  *CUZ*FX 
£  *  X  3  (  5  0  )  <  2  ►  XS  (  57  )  *R .<  2 $  ALT  ♦  XS  (  60  ) 

XDOT  (7)  — XS  (  3  )*RHfie/i?E-:<3(  5  )  /  R  £•  +  XS  (  3  )  *  WU-XS  (  9  )  *WN 


F.*XS(ll)*CEX*XS(12)*CEYfrXS(l3)*CFZ 

£♦  (  XS  (  1', )  +  XSF;NL>  *r.rx«-«x*  (XS  (  l‘> )  *YSf-ML  )*CE Y*WY 

£♦  (  X  S  (  16)+Z$FNL)  *CEZ*W7 

£  ♦  X  S  (  1 7  )  *  C  E  X  *  W  Z  -  X  S  (  l  H  )  *  C  E  X  *  *  Y  -  X  S  (  1 9  )  *  C  E  Y  <■  W  Z  ■ 
fi+XS  (20)*CEY*WXfXS<21  )*CEZ*<IY-XSI?2J.*CEZ*WX 

XDOT (H)=-XS ( 2  )* OMEGA J-XS  (  3  )*RHON/RE  >  <S  (  A  )  /RE-XS  (7J*W J 
£  +  XS(  9>*WE  +  XS  t  11  )*CNX*XS  (  12  )*CNY  +  XS  (  l  3)  *C,NZ 
£♦ (XS( 14)»XSFNL>  *CNX*WX* (XS< 15  >  *YSFNL) *CNY*WY 
E»(XS(16)  ♦  ZSFNU  *CNZ*WZ 

£♦  XS(  17)  *CNX*'RZ-XS<  13)  *CHX*RY-XS  ( 19  )  *CNY*WZ 
£  +  XS(  20  )  *CNY*WX*XS<  21)  *CNZ*WY-X$ (22  )  *CMZ*WX 


XDOT  (  9  )  =XS<  2  >  *F9  2-XS  (  3  )  *RHOU/RE<  XS  (  6  )*TL  AT/RE+XS  (7  )  *WN 
£  —  X  5  (  c3)<cWE+-XS  (  LI)  *CUX*XS(  12  )  *CUY*XSl  13>*CUZ 
£♦  (  XS  (  16  )  +XSFNL)  *CUX*WX+  (  XS  (  1 5  )  +  Y SF ML  )  +CUY* WY 
£  + ( XS ( 16 ) ♦ Z  $  FNL ) *CU Z*w/ 

S+XS ( 17) *CJX*WZ-X3( 18 ) *CUX*WY-XS< 19  )  *CUY*WZ 
£ ♦ X  S ( 20 ) *CJy*WX«-XS(2l)*CUZ'MY-XS (22)*CUZ*WX 

XDOTl 10) *XS (3) ^RK3-XS(56)*^K3-XS( 57) »RK3*Air 

00  2  1=11,25 
2  X  DOT ( 1 ) =0 • 

XDOT (26) =-XS (26 )/TAUS( 1 ) 

XDOT ( 2  7 ) =-X  S ( 2 7 ) / T A U S ( 2  ) 

XDQT(26)*-XS(23)/TAU$(3) 


DO  6  1=29,55 
6  XDOT { I ) =0  « 

XD0T<56)*-XS(56)*VGN0/DIST(1) 
XOOT( 57 ) =0. 

X00T(58)»XS(58)*VGMD/DIST(2) 
XDOT { 59 )=-XS ( 5  9 ) ♦VGND/D  1ST ( 3 ) 
XD0T(60)*-XS (60)*VGND/01ST<6) 
RETURN 

ENTRY  XSDQTO 
DO  11  1=1,6 

11  XS( I >=GAUSS (0. ,SDWSO(  I)  ) 

DO  13  1=11,22 

13  XS< I }  =  GAUSS (0. >SDWSO( I  )  ) 

DO  15  1=23,55 

15  XS( I )  =  GAUSS (0. , SRrfSOl I )  ) 

DO  17  I =56,57 

17  xs<  i  )-(*,auss<  o.  ,sowsom  ) 

00  19  1=53,6  0 

19  XS ( I) -GAUSS ( 0. ,SOWSO(  [)  ) 
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c  SET  STEADY  STATE  AND  C  DR  RELATED  INITIAL  CDNDIT  IONS 

ALT-XTR A J( A ) 

RLAT=»XTRAJ{  1 ) 
nMEGAN=OMES A*COS (RLAT) 

0  M I;  G  A  U  =  0  M  E  3  A  *  S  I  N  {  R  L  A  T  ) 

R ANHH  AD=GAUSS< . 0, 1.0133 ) 

C  HE  AD  ®C  OS ( R ANHE  AD ) 

SHEAO=-SIN{RANHEAO) 

XSI3>-XS(5S)+XS(57)*AL-T 

X  S ( 7 ) *- C  XS  C 23 ) /G+XS( 26) /G*XS( 35)*G+XS( 50)  )*CHEAD 
£  MXSf24)/G  +  XS(27)/G  +  XS(36)*G-XS(52))*SHEAD 

£  -  X  S  (  5  9  )  /  G 

X  5  (  8  )  *  (XS(24)/G+XS(27)/G*XS(36)*G-XS(52))*CHEAD 
£  ♦  ( X  S  (  2  i )  /G  +  XS  (  2  6 )  /  G  *XS  (  35  )  *G  X  S  <  50  )  )  *S  HE  A  D 

£  ♦  XS(5S)/G 

XS(9)  =  (XSm*aMEGAU 

£  ♦(XS(12)-XS(15)*QMEGAN*SH£AD*XS(19)*0MEGAU 

£  *  XS(  20)  ^Q  ’iEGAN't'CHEAD  )  *  C  H  E  A  D 

£  MXSILIJ  +  XS  (1'4)*0HEGAN*CHEA0-XS(17)*0MEGAJ 

£  ♦  X  S ( 18 )*QM5GAN*SHEA0)*SHEAD) /OMEGAN 

XS(10)*(2.*G/RE )*XS(3)-XS(25)-XS{28)-XS(37)*G*G+XS (49)*G 
£  ♦  XS(SO) 

RETURN 

END 

TRUTH  MODEL  FOR  HONEYWELL  GG1342  R  LG  AND  BELL  MOD  11  A CC E . E ROME  I E R 
IP RDATA 

NF-1,  N S  =  60  »  TF=900.,  DTP R NT  =  15 0 . ,  D TN3 YS  =  2 . , D TP R P L  =  9 .  , 

LPRXF=.F.,  LPRLT=*.F.  *  L  PR  0G= . F •  ,  L  P  P=  .  T  .  ,  NXT  J  *  1  6  ,  LX  T  J=  .  T  .  , 
M=0,LPRXTJ=.T. ,_CC=.T. ,DTCCPL=2. ,IPASS=50, 

6  0*0. 

1*0. 


1.1,1. 

0,0.0. 


1  I  NS  T  AUS ( l ) *60. *60.  ,60., 

OIST(l)  -1519026.3,60761.03  33 ,60761.0333, 364566. 19, 


S  D  W  S  D (  1 )  =  1 • 6794 4F  — 5  » 

1.  , 
6.  E  —4 , 


l.  67944E-6  , 

l »  , 

‘3.  E  -  4  , 


23.877513  , 
1 .  E  - 1 , 
9 .  F-4, 
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1.  e-2 

3  .  9  7  3  s  3  E  -  1 
5.  E-6 

2.5  E-5 

2.5  1—5 

A .  •>  S  ^  /  S  M  -  ^ 

2.2  54  !:-4 

?.  /9503E-9 
2.79503E-9 
2.79503E-9 

6.2  U  HE -9 

6. 2  11  13F.-9 
6.21113E-9 
1.531136-5 
4.343 l 3  E-5 
4.848136-5 
4.  6+2 

5.474  E  — 4 

SOHS(l)-  4.3 1776G-7 

i.6i  r—4 

4 .  1  1522  6  —  5 

5.  E  *  2 

1.127  E-3 

S0VF0( L)-l.,$ 

1. 


3. 8 7340 E -3, 

3. 9 7 35 06 -3  , 

5.  £-6, 

5.  E-6, 

2.4  f:  —  5 , 

2.5  '  E-5, 

2.5  E-5 , 

2.5  E-5 , 

4.5537  5c  —  4, 

4 . 5  5  3  7  5  E  —  4  , 

2.2  44  E  —  4 , 

2.254  E-4, 

2. 70  50  3  r— 9, 

2.79503 £-9 , 

? • 79503  E  — 9 , 

? . 7 95 03 E -9, 

2. 795936-9, 

2.7  9 5036-9* 

6.21118  6  —  9, 

6.211186-9, 

6. 211136-9, 

6 . 2  1 1 1 S  E-9  » 

6.211136-9, 

6.211136-9, 

1.53113 E-5, 

1 . 5  3  1 1.  3  E  -  5  , 

4.843 136-5, 

4.843136-5, 

4. 84813 E-5, 

4.343136-5, 

3.  6-2  , 

8.372  6-4, 

1.127  E-3 , 

5 . 3 1 7  7  6  E  -  7  , 

5.81776E-7, 

1.61  E-4, 

1.61  E-4, 

4.  U522E-5, 

4.115226-5, 

8.372  E-4, 

5.474  E-4, 

1,0,0»3437.7467 
2,0,0.3437.7467 
3,0,0, 1. 

4, 0,0,1. 

5,0,0, 1. 

6 , 0 , 0 , 1  « 

7,0,0,3437,74b7 
3 »0 ♦0,3437* 7467 
0.0,0,3437.7467 
0,0, 0,0. 

TIME  (SEC) 

LONGITUDE  ERROR 
POSITION  *4RC  MIN* 

LATITUDE  ERROR 
POSITION  *ARC  MIN* 

ALTITUDE  ERROR 
ALTITUDE  *  r  G  E  T  * 

{AST  VELOCITY  ERROR 

velocity  *eps* 

kCWTH  VELOCITY  ERR  op 
VELOCITY  * r P S * 

UP  VELOCITY  ERROR 
VELOCITY  P  S  * 
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i 


r  A  S  T  TILT 
TILT  *  A  W  C  MIN<- 

N  0  ■<  T 1 1  TILT 
TILT  «A^C  MlNc 

AZIMUTH  URO* 
A  Z  H  *  A  C  Ml  N  * 


Appendix  C 

PROFGEN:  A  Computer  Program  for 

Generating  Flight  Profiles  (Ref  11) 

PROFGEN  is  a  six  degree  of  freedom  flight  profile  generating 
program  that  computes  position,  velocity,  acceleration,  attitude, 
and  attitude  rate  of  an  aircraft  flying  a  specified  route  over  an 
ellipsoidal  earth.  It  does  not  model  the  aerodynamics  of  the  aircraft; 
therefore  the  body  coordinate  frame  is  coincident  with  the  coordinate 
frame  of  the  flight  path.  This  results  in  the  inability  to  simulate 
maneuvers  that  require  side  slip,  an  angle  of  attack,  or  crabbing 
motion. 

Four  basic  maneuvers  are  included  in  PROFGEN: 

Climb  or  Dive 
Coordinated  Turns 
Sinusoidal  Heading  Changes 
Straight  Flights 

The  aircraft  may  accelerate  during  any  of  these  maneuvers.  Flight 
profiles  are  constructed  by  concatenating  up  to  50  of  the  basic  maneuvers. 
Different  types  of  aircraft  are  represented  by  the  rates  and  accelerations 
specified  for  each  maneuver. 

The  earth  model  in  PROFGEN  is  an  ellipsoid  having  values  based 
on  the  DOD  World  Geodetic  System  1972.  Gravity  is  a  function  of 
both  latitude  and  altitude  v/ith  both  radial  and  level  components. 

PROFGEN  uses  a  fifth  order  polynomial  to  control  roll  rate. 

The  body  frame  gradually  rolls  up  to  the  maximum  roll  rate  with  respect 
to  the  navigation  frame,  then  gradually  rolls  out  to  the  desired 


roll  angle.  For  a  given  maximum  roil  rate,  a  smaller  desired  roll 
angle  produces  a  greater  roll  acceleration.  In  an  effort  to  avoid 
abnormally  high  accelerations  in  rolling  to  small  angles,  PROFGEN's 
maximum  roll  rate  for  horizontal  turns,  is 

=  ^M(1  '  ^  (C-l) 

where 

n  =  Normal  Turn  Acceleration  in  g's 
=  Maximum  Roll  Rate 

For  low  acceleration  (small  g)  turns,  only  a  small  bank  angle  is 
required  and  a  lower  maximum  roll  rate,  through  Equation  (C-l),  is 
used  to  achieve  this  angle.  For  higher  acceleration  horizontal  turns, 
however,  the  maximum  roll  rate  remains  essentially  unchanged  as  the 
roll  angle  approaches  90  degrees. 

The  result  of  using  Equation  (C-l)  and  the  fifth  order  polynomial 
to  control  roll  rate  is  that  an  arbitrary  time  constant  is  being 
used  to  control  roll  acceleration  which  does  not  necessarily  reflect 
the  dynamics  of  the  aircraft.  Calculations  based  on  the  aircrafts 
roll  time  constant  were  added  to  PROFGEN  to  correct  this  problem. 

Roll  rate,  f,  is  determined  from 

*  =  -  e't/T)  (C-2) 

where 


<^=  Maximum  Roll  Rate 
i  =  Roll  Time  Constant 
t  -  Time 


Integrating  (C-2)  to  obtain  instantaneous  roll  angle,  <fr,  at  time 
t  results  in 


Substi tuti ng 


-  ^(t  +  te  ^t-t ) 


e’t/x=  1  -  t/x  +  t2/2x 


gives 


4>  =  fyt  /2t 


( C-4 ) 


Solving  for  t  yields 


,  •  ,°  5 
t  =  J  2t  4)/4>m  | 


which  is  the  approximate  time  necessary  to  achieve  a  given  roll  rate.  It 
is  assumed  that  the  same  time  constant  x,  applies  for  roll  out;  therefore, 
twice  the  time  given  in  Equation  (C-5)  will  be  needed  to  achieve  a  desired 
roll  angle. 

Using  the  fifth  order  polynomial  in  PROFGEN,  the  time  to  complete 


a  roll ,  2t,  is  given  by 


2t  =  15$/8$. 


Substituting  Equation  (C-5)  into  (C-6)  yields 


•  ,  i  •  ,°‘5 

4^  =  1 5<J>/ 1 6 1 2 1  <}>/  fy|| 


(C-7) 


Thus,  the  maximum  horizontal  roll  rate,  will  now  be  computed  based 
upon  the  roll  time  constant,  t,  for  a  desired  roll  angle,  f,  and  maximum 
roll  rate,  4>^.  This  overall  effect  will  he  to  change  the  slope  of  the 
fifth  order  polynomial  so  that  the  body  frame  rolls  out  at  the  desired 
roll  angle  at  a  time  that  is  approximately  (to  second  order')  consistent 


m 


with  the  aircraft's  roll  time  constant. 

It  was  felt  that  the  four  basic  maneuvers  were  overly  restrictive, 
especially  for  the  fighter  aircraft  used  in  this  simulation.  Therefore, 
PROFGEN  was  modified  to  include  a  fifth,  roll-only,  maneuver. 

A  listing  of  tho  necessary  changes  to  the  program  is  shown  in 
Appendix  0.  It  was  also  necessary  to  modify  the  output  of  PROFGEN  to 
include  roll  rate,  pitch  rate,  and  yaw  rate.  These  changes  are  also 
included  in  the  appendix. 

PROFGEN  would  be  a  more  effective  flight  profile  generator  if 
additional  modifications  were  made.  For  the  sine  maneuver,  initial 
roll  rate  as  shown  in  Equation  38  is  not  realistic.  Also,  fighter 
aircraft  seldom  maneuver  in  just  the  horizontal  or  vertical  planes. 
Although  PROFGEN  has  the  capability  to  initiate  turns  from  various  pitch 
angles,  a  more  realistic  manuever  would  be  to  initiate  pitch  changes 
from  arbitrary  roll  angles.  Finally,  the  method  of  storing  samples  of 
the  flight  trajectory  data  during  the  turn  maneuver  should  be  changed. 
The  roll  into  and  out  of  a  turn  should  be  sampled  at  a  different  rate 
than  the  turn  itself.  Presently,  in  order  to  correctly  sample  the 
faster  dynamics  of  the  rolls,  computer  resources  are  expended  by 
sampling  the  turn  itself  at  a  higher  rate  than  necessary. 


4PP-I.N0IX  0 


PRnFGrN  UPDATE  FOR  R  OLL  [INLY  MANHJVFR 

M'D'nt  nor lout 

M  PROFCFN.  I  V)') 

CALL  E  T  Ai)'lT  (  F-  Ti  /OUT  ,  F:  T  AYQUT,  <  TA/DO  T  ) 

*  I  A  U  C  7  H  .  *>  3 

?  ,  C  T  A  XO  0  T  ,  L  T  AY  0.1  T  ,  f  T  A  Z  l)  0  T 
M  PROF GLN. 1724 

WRI  TF  ( ?> ,  101 )  TOF-F  ,  TON  ,  P  *1  AX 
=>1  PQOFGF:N.  17  41 

W?ITF(  (>»  101  )  Tiir-P  ♦TOM  ,  P  MAX 
M  P  -m-GvH.  ]  7  4d 

W  PIT 'r  (6, 101)  TOFF  .TON,  s  -I  AX 
<■1  PROPCC.M.  1  7  5F> 

•iRITcISflOl)  T  1 T  r  ,  TON  ,  P.-1AX 
M  PR0FGGN.1764 

101  FO.RNATI  GX  ,  l  ON-  ILLUP  S  T  0  ?  S  AT  ,  G2  0  .  L  0  /  ,  ‘j  X  , 

F.20HPOLL  DOWN  STARTS  AT  , G ?0 . I  0/ , 3 X , 1 7 HN A X  POLL  PATE  IS  ,023.10) 

<=1  PROF-GEN.  IGdb 

E  GUIVALENC-'  <  F  I  XC  D  <  ?  )  ,  R  A  0  P  R  0  ) 

*1  PROFGLN. 1700 

RMAX^pRHQRZ/'R AOPRO 
MOUNT  POLL  T  C 
*1  PROFGFN.lbO 
P  ? HOP  Z  =  0 . 

*0  APR80.9 

IF  (  I  TURN.  FQ.2  )  ROLA  NO  (  I  SF  G  )  =  A  T  A  N(  T  A  CC  (  I  S  E  0  >  /  A  2 . 2  /  C  T  5  (  t  T  A  i  (  3  -1 Y  )  )  ) 
IF  (ITUPN.-FQ.2J  TRTC*SQ’T  (  A35  (  2  .  $R T C * R OL A NG <  I  S  E  G  )  /.RO.R  AT)  ) 

IF  (  ITUPN.  tQ.  2  )  RPNJPZ  =  AOS  (  IS.  *?OLA-IG(  I  SFG  )/(!•>.  *TST0  )  ) 

IF  (ITURN.pO.Z.ANO.RPHDPZ.GT.ROL’RAT)  R  R  H  0  R  Z  3  R  3  l  R  A  T 

*  0  40078.5 

CONrtON  /PP-3LK/PP:3LK(  15) 

M  APR80.6 

EQUIVALENCE  (  P  R  3LK  (  13  )  .  RTC  ) 

<=1  A  1)0  7  8.  b 

C  PP3LKU5)  RTC,  POLL  TIP.F  CONSTANT 

*0  FFnn0.75 

CONNON  /PITCH /?ITCH(5C)  /PR3LK/PY  i  L  K  C  IS) 

M  FFT8J.92 

EQUIVALENCE  <PRF«L<(15)  ,RTC) 

4  I  F  F  R  30.  LOS 
?,  PTC 

* !)  AUG  73. 64 

Cll-nOU  /PI  TCH/P  ITCHFO)  /P-'.iLK/?--  >  L  <  (  1 1  )  /  S  i  GL'J  T  /  Sr.  G_  R  T  (  t  J  ) 

<- 1  A  IJG7  3.6  5 

F  QU  I  VALENCE  (  PP-1L<(  IS  )  ,  PTC) 

M  H  IV  7  0.  A  7 
2  ,  P  TC 

*  I  N  n  V  7  0  .  I 
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o  o 


5,RTC/0.5/ 

*ncNT  ROLL 
*1  PR OHG EH. L2B 

CO*. UN  /fn.ANG/.RUL  AN  GOO  > 

<>1  PR0FGIN.168 

IF  (  I  TURN.  F'J.S  }  TRTO  UOR  T(  AliS  <  Z.  4R  TC4ROL  A  JG<  ISEG  )  /  R)_R  AT  )  ) 

IF  I  1  T  0  R  N  .  -  0  .  8  )  R  R  -C)  R  7  =  A  ‘i  S  (  1  5  .  v  *  ,JL  A  NG  (  I  S  L  G  )  /  (  L  *  T  K  T  C  I  > 

IF  (  ITURN.  ::0 . 5.  AND  .PRH.IR  7.  GT  .  R  OLRAT  )  P.  RiljR  L  =  RU_  K  A  T 
IF  (  I  TURN.  :i  Q.  8)  CALL  T S T UP5 ( T DON F ) 

if  (  i turn.  ::o. 5  )  turndijn  =  o. 

IF  <  I  TURN. EQ, 5)  rrcoff=«l. 

<■0  PROF  GEN.  1  76 

GO  TO  ( 40,50,60,70,80), ITURN 
M  PROF  G  c  N  •  2  2  2 
C 
C 

C  44<*  ROLL-ONLY  “  A  N  E  U  V  F  R  444  -  . 

C 
C 

SO  H  =  HL IN  I T( T . TF ,H,HNN) 

CALL  HL  l  M  5  I  h  ,  R  R  COE  F  ) 

CALL  K  J  T  M  L  R  (  M  »  T  » X  »  -t ,  F  ,  m  0  E  »  E  R  P  ,  H  M  X  ♦  H 1 N) 

IF  ( T.Gt  .TDONE  )  TRN0J-U1, 

CALL  OUT ( T  ,  T  I  ,  I  PkNT, I R I TF  ,  IP  LOT) 

IF  (T.LT.Tr)  GO  TO  80 
RETURN 

41  PR  OF  GEN. 414 

COMOON  /RD_ ANG/ROLANGI 50) 

*1  PR0FGEN.433 

4  ,  ROL  ANG/50U.  / 

41  FE880.47 

IFITURNt  ISFO.EQ.5)  M RITE  (6,700)  TEHP5 
♦1  FE380.Z0 

COMMON  /RO.  ANG/RULANGI  50) 

41  FEB  ?.  0.42 

TEMP5  =  R0LASG(  ISCO/RAUPRO 
4  1  FFU0.65 

700  F(!R‘1AT(  5X,  74HTHIS  FLIGHT  SEGMENT  IS  A  POLL-ONLY  MANEJVER  X  I  T  H  A  05 

4SIRLD  CHANGi  -  IN-ROLL  OF,G12.5,OU  0 1  G  R  F  t.  j  .  ) 

<M  P  ?  0  F  G  :.l  N  ,  8  6  6 

SUBROUTINE  ML  H 5 ( H , R R CO EF )  j 

44  H  L  1*5  ADJUSTS  TIE  STEP  5IZF  IN  A  ROLL-ONLY  MANEJVER  j 

C44  SC  THAT  THE  PROGRAM  WILL  PAUSE  AT  TO ONE  WHEN  THE  • 

C 4  4  AIRCRAFT  IS  FINISHING  A  ROLL-ONLY  MANLim  R  . 

C  5 

COMMON  / S U p  L  t;  /  S U P L f  (  11)  ; 

C 

I  ou I  V  AL F  NO-  (  5UPLF (  l )  , r  » 

f  cu  i  vac  ini;-  <  s u PL 1  ( ? ) ,  r  f  ) 

f  GUI  /ALL  NOE  (  SUPL:  (  ^  )  ,  1  OUNt  ) 


1 5B 


w 


§ 


i 


c 

c 

c 


TRANSFER  TO  PROPER  S  U  ft  S  f  G  M  t"  M  T 

if  ( r.LT .  dom;:  >  go  rrj  10 

if  ( t.ge  .  done.  auo.t.lt.tf)  r,n  to  ?r> 


C  SFT  RRCUEF  AND  LIMIT  H  IF  NECESSARY 

10  CONTINUE 

H  =  HC HOP (  H.  T ♦TOONr ) 

P  f  T  U  v  M 

20  CONTINUE 
RRC0EF=9. 

RETURN 
f  NO 

*  I  PVOFGLN.  L0<)3 

COMMON  /<  )_ANG/ROL AN3150) 

*  I  PRQFGFM.  io.-u 

R  0  •_  A  N  G  (  I  ) -ROL  A  NO  (  I  )*.R\DPRO 
<=1  E  EH  8  0 , 9  4 

INTEGER  R  E  S  T  R  T ,  P  A  T  H  (  2  ) ,  TRNTYPI5)  .TORN 
-0  Ff ft  8 0.9  5 

*  0  F  P:  ft  8  0 . 1 0 1 

DATA  TRNTYP/4HVFW7,4-(H0RZt4HSlNC,4HSrRT»4HR3LL/ 

*1  FER80.107 
2, RQLANG 
■>0  PRGFGEN.  1263 

GO  TO  ( 10*2O»3OtlO»lO)» I  TURN 

*  I  F  £  8  8  0.77 

COMMON  /«3'„ANG/k'JLAHG(  50  J 
*1  APR  8  0. 36 

COMMON  / R 0  _  A NG / R OL  ANG (50) 

*1  PROFGsM.  144t> 

IF  ( ITURN. 6Q.5)  GO  TO  20 
*1  PROF  GEN.  14  69 
C 

C  ROLL  RATE  COMMAND  FOR  A  ROLL-ONLY  MANEUVER 

20  ?(JL0TC=0. 

T  l=TDONE-TI 
T  F  =  T  -  T  I 

IF  (RRC0EF.EQ,*1.)  R3LDTC=  T  E  *  TE  *  (  T  F -T  L  )  *  (  TE -T  1  )  /  HI  *  *  4  ) 

R  OLD TC=RJLDTC*N  IGN<  1.  .ROLANf,  (  l  5LC  ))  *16,  *RRH  )RZ 

RETURN 

*  I  PROF CF N.  1770 

SU,3 ROUT  I  N-  TS TUP5 < THOSE  ) 

r 

rc»  ORI()R  TO  (  ACH  ROLL-ONLY  MANEUVER,  TS.TUr’G  COMMUTES  TU  T  IMF. 

C**  AT  WHICH  THE  CHANG-  IN  1  OL  L  ANGLE  JILL  OUAL  "-OEANG".  IF 

r.**  AND  4  h  \  -i  SUCH  T  I  .1 .  IS  »r,M:  II,  IHI  f\  i:  !JV  •’  V  Is  COFPLfclt  AN  J 

CR*  T  H I  ROLL  RATE  IS  SNITCH'  0  OFT  IN  SO  i  •'  JUT  J '-,l-  FLTuTH. 

C 

COMMON  / S  UP  LE / > UP  L 1  (11) 


•Y 

A 
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COMMON  /  ^  0  _  A  M :;  /  K  tlL  A  NG  <  SO  > 

cnrf  M-t  /fix :  , ) / r- 1 xo i) <  ) 


F.  QU  I  VALENCE 
FOUIVALfcNC!: 
F  U  U  l  V  A  L  F  N  C  v 
E  OU  I  V t  .4C  : 
t  S  U  I  V  ALLNCF 


{  F  I  XI  I)  <  ?  )  »S  A  OF  HO  ) 

(  S  L)  P  L  E  (  2  )  ,  T  r  ) 

(  S  I  ELI  (  n  .  T  I  ) 

(  SU2Li:  ('<),  l  6  L  0  ) 
l  SJPLE  <  11  )  1  HHQV  7  ) 


ECO 


2  00 


t  o 


n  T  =  A  IS  (  (  15.  *HrtL  ANC;  <  I  SEC  )  1/(0  ■  *  P  W  H  0  H  Z  )  ) 

T  0  □  N  E  =  T  I  ♦  n  T 
HM.\X=HHHOHZ/HA-)?eO 
WHITE  (6,1)0) 

If-  (  T  0 ;)  N  f- .  G  T  •  T  f  )  W-MTF:  1  6,200) 

IF  (  TOO  N  t  ,  G  T  ,  T  F  )  TOOHE-  TF 

F  OH  *•  A  T  (  )  X  ,  V  7M  T  HE  OESIHrl)  C HA nGF- I  1  - H UL L  IS  ACHIEVED  AT  TI1:  =  i 
£0  2  0 . 10,  /  ,  5<  ,  l'H  -AX  H  C  L L  2  ATI  =,02  0.  10) 

HFTUxN  .  , 

F  Q  H  HAT  (  5  X  »  4  o  H  T  H  L  S  F  G  H  f:  N  T  LENGTH  IS  HIT  LONG  “HOUGH  F  jk  HOi..) 

FNO 

p  a  o  f  r,  f.  s .  l  *  2  3 

IF  (TUHH(I).LT.l  .OH.  T  J  R  N  (  I  )  .  G  T  .  5  )  If:HH(ll)=l 


■  f 


( 


1  ' 
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Appendix  E 


Older  generation  strapdown  laser  gyro 
and  accelerometer  model  used  in  the 
development  of  the  truth  and  filter 
models  in  Appendices  E  and  F.  (Ref 7) 


— 

State 

j 

1 

Initial  Variance  (Pjq)  , 

Driving  Noise  (Q^) 

Sasic  INS 

Position  Errors 

(1500ft)2 

0 

Velocity  Errors 

(2ft/sec)2 

0 

Attitude  Errors 

(0.5  mrad)2 

7.6x10  ^rad2/sec 

Accelerometers 

Bias 

(250  ug)2 

0 

Scale  Factor  Errors 

(500  PPM)2 

0 

Input  axjs  misalign 

p 

(10  arc  sec) 

0 

CorrelatedxNoise 

Tj  =  60  min 

(40  u g)2 

2Pto/Tl 

T2  -  15  min 

(20  ag)2 

2Ptc/T2 

Gyros 

Drift  Rate  Bias 

(0.09  deg/hr)2 

1. 47x10’ 18rad2/sec3 

1  Scale  Factor  Error 

(100  PPM)2 

0 

l 

1 

i  Input  Axis  Misalign 

j 

2 

(6  arc  sec) 

0 

APPENDIX  F 


SOFE  SUBROUTINES  FOR  TRUTH  NOOFL 

S UNROUT  INF  A  M  END!  !RUN,T  ,NF ♦ MS t NXT J • XF y XS » XTR A J ) 

!)  I  !1 MS  I  ON  XF(NF)  *XS{MS>  , XTR A J < HXT J  ) 

RETURN 

ENTRY  AMEN  i.)  Q  f 

RETURN 

END 

SUBROUTINE  E  S  T  I  X  (  I  RUN  ,  T  ,  t  N  S  t  NX  T  J  ♦  XF  *  XS  ?  X  TR  A  J  ,  N  TR  i r  ) 
DIMENSION  XF(NF).XSMS)»XTRAJ(NXTJ»yPF(NTR) 

RETURN 

ENTRY  ESTIXO 
RETURN 
F  NO 

SUBROUTINE  FOOEN! IRUN,T ,HF , NS » NXT J » XF , XS * XTR4 J » 
ENZF»NZQ*P»0) 

DIMENSION  XF ( Nr ) ,XS( NS ) ,XTRA J! NXTJ ) ,  F< NZF ) ,Q(N?Q> 

RETURN 

ENTRY  FOGENO 

RETURN 

ENO 

SUBROUTINE  HR  Z ! I  RUN*  T *NF*NS>NXTJ*Xe»XS»XTRAJ»NTRjPF» 1MEAS> 
f.M  »H.Rt  ZRES) 

DIMENSION  XF(NF ) yXS(NS) yH(NF) yXT%AJ(MXTJ) yPF(NTR) 

RETURN 
ENTRY  HR ZO 
RETURN 
ENO 

SUBROUTINE  SNOY S < I R J N * T , NF » NS • NXT J , XF * XS » XTR A J ) 

COMMtJN/SNOI  S/ SOWS  Of  A3)  ,  SOWS  (  1  3  )  ♦SOMFO  ( 1 } 

CD",  "tON/TCSY$/TAUS(6)*DIST(A) 

C  DM  MON /TR  •)  C  ON  /R  E  ,  G  » ON  EG  A  »  E  »  R  K  1  ♦  RK  2 »  RK  3 
DIMENSION  XFINF  )  ,XSM3  )  ,XTR  A  J  (  NXT  J  ) 

VGND®S3RT(  XTR  AJ  (  «)  **  ?.  ♦  X  TR  A  J  (  9  )  ) 

0T-T-T3LD 
S  R  0  T  3  S  0  R  T  (  0  T  ) 


STOFV-SOWSI Z>*SRDT 

X  S  C  /)=/$! 7) ♦GAUSS! O.DtSTDEV) 

S  TOE  V  =  S  D  M  S ( 3 ) *5  ROT 

XS! b)-X SI «) ♦GAUSS! O.O.STOFV) 

S  TOE V=SDWS( A ) *S RUT 

XS  <U)=XS( '»)  ♦  GAUSS!  0.!)  *  S  TOTV) 


s  r  o  t  -  v  -« $  o  w  s  ( s )  *srot 
x  s  1 1  o)  =»xs  c  i  o )  »c.  a  us  s<  n  .o ,  stde  v ) 
s  rut v-snws ( 6) *srot 
y  s  t m *xs( ii i*gaus sto.o, srotv) 

STDEV-SOWSC  /)*SROT 
x  s  (  u )  =  x s  a  > )  ♦  o  aus s  ( o . n ,  s td f  v  > 
s  r :? »  v=sows  ( )  *sopt ( ?  .*o t/taus  c  i  ) ) 

X  S(  .? 5  )  =  XS  ( 2r>)  +  GAUS S(  0.0  .  STDL  V  ) 

S  TOE  V=SDWS(  ‘l )  *SCKT  t  ?  .  vj)  T/TAIJS  (  2)  ) 

X  S  (  20>=XS  (  >6  )  ♦GAUSSt  0.0  .STDEV  ) 

STnGV«$DWS(  10)*S0RT(Z'.*!)T/TAUS(  3)) 

X  5  (  2  7  )  -  XS  (  Z  7  )  +  G  AUS5  (  0. 0  ,  STDF.  V  ) 

S  TOE  V- SD  WS ( 1 1 >  * S 08  T ( Z . *  DT / T  AUS ( 4  )  ) 

X  S  t  >8  )  =  XS  «  PS)  fG  AUSS(  0 .0  ,  STDEV  ) 

ST  on  V  =  St)WS  (  1?.  >*SOR  T(  ?.  .’MU/TAJS  (  ‘J  )  ) 

XS!  29)  =  XS  (  2  9 )  GAUSS  (  0 .0  ,  STDEV  ) 

S  TOE  V  =  S  OWS  (  1  3  )  *  SORT  {  2  .  *  DT  /  T  AUS  (  6  )  ) 

X  S  (  3  0  )  =  X$  (1 0  )  +G  AUS  S  (  0 . 0  •  S  TOE  V  ) 

S TOEV-SDtfS ( 14)*S0RT( 2 . *  0 T* VG NO/O I S T ( 1) ) 

X  S ( 40) =  XS( 40)  M14USS( 0 .0 ,  STDEV ) 

STIFV-SDWSl  15)*$G-?T(Z.*0T*VGSD/0IST  (2)  ) 

XS(4Z)»XS(4Z>*>GAUSS<0.0, STDEV) 

STDE  V=SDWS  (  14  )*SOST(Z  .  <=  OT* VGMO/ 0 1  S  T  (  1)  ) 

X  S  (  4  3 ) -XS  <  4  3 ) ♦ G AUS  S  <  0 . 0 , $  TOE  V  ) 

STOEV=SO*S<  17)*SQRT<  2 . * OT* VG ND/D  1 5 T ( 4 }  ) 

XS ( 44 ) -X S < 44 )+G AUS StO.O, STDEV) 

FMTkY  SNOYSO 
T  QLO  =  T 
RETURN 
END 

S  U'.!  R  GUT  I  ME  T.R  A  J  (  I  RUN ,  T ,  NF  » NS  ,  NXT  J  ,  XF  ,  X  S  ,  XT  R  A  J  ) 
CtlM>il]N/TRJCOl*!/RE,G,3HEOA,E,RXl,RK2,.RK3 
D  I  HE  NS  TON  X  F  (  N  F  )  ,  X  >  (  N  S  )  .XTRAJ(NXTJ) 

DIMENSION  TITLEtZO; 

RETURN 
ENTRY  TRAJ3 

READ  (3)  TITLE. TGOAY, CLOCK 

READ  (3)  I?RU3,NSECT,LL^ECH,TSTART,VT0.PHEA03,P ITD, 

6  ALFA3,LAT3*L0NO,ALT3.I  PR  NT  ,  I?.  ITE  ,  I  P  LG  T .  ROLR  A  T ,  L  UN  I  T 
READ  ( j )  S E  GLNT  ,  RF  STR  T . TURN , NP  A TH . P  ACC , T A  CC . HE  A 0 , 

£  P  I  T  ,  I)  T  0 ,  H  3  D  E  »  E  R  R  0  R  ,  H  ",  A  X  ,  Hfl  I  N 
IF  (IPUN.GT.i)  CU  T3  LO 

P  v  I  ,-I  T  *  ,  »*  ” 

WRITE  (6,100)  T I TLE, TODAY. CLOCK 
100  FURHATt IX,7UTITLE:  , 20A 4/ IX , 7HD ATE :  ,  A  10  / 1 < , 7 H T I nE : 

PRINT*,”  IPROH!  ”  *  I  P  R  f)H 
PRINTS,”  NSEGr:  ” , NS  EOT 


,  A  1 0 ) 
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10 


PRINT*," 
PR  I  NT*,  " 
PR  INTO," 
PRINT**" 
PRINT*," 
PRINT*," 
POINT'  .  " 
PRINT'," 
PRINT*," 
PRINT*," 
PRINT*," 

PRINT*," 
PRINT*," 
P  o I  NT* , " 
PRINT*," 
PRINT*," 
PRINT*," 
PRInT*," 
PRINT* ," 
PRINT*," 
PRINT*," 
PRINT*," 
POINT*," 
PRINT*," 
CONTINUE 


L.NfitM: 
TS  TART  : 
V  T  0 : 
P-l>'UO  : 
P I TMCO  s 
A  l  F  A  0  : 

I  !* «:  N  T : 
l RITE: 
.PLOT: 

R  0  L  R  *\  T : 
LJNIT! 


",llme:h 
" ,  T  S  T  A  R  T 
"♦'/TO 
" ,  PIU*  ADO 
"  ,  P I  TO 
M  F AO 
" ,  I  PRNT 
MKI  TE 
",  I  PLOT 
"tROLRAT 
" , LUN  IT 


SEGLNT 

RESTRT 

TJRN: 

N  P  A  T  H  : 
P  A  C  C : 

T  A  CC : 
HEAD! 
PIT:  " 
D  T  0 : 
MODE : 
ERROR: 
HR  AX! 
HrtlN! 


: SEGLNT 
: " , RE  STRT 
"  ,  T  U  R  N 
",NP ATH 
", P  ACC 
"  ,  T  A  C  C 
",  HE  AD 
♦  PIT 
" ,  0T3 
" , NODE 
"♦ERROR 
"  ,  H  N  A  X 
" , HM I N 


RE=209256A0. 

G=32. 0931576 
ONEGA=. 7292U51E-4 
E=i./293.3 

C  STANDARD  K  VALUES  ARE  <1=3. E-2,  <2=3. E-4,  K3=l.E-6 

C  OPTIMAL  K  VALUES  ARE  <1=1.003,  K2=4.17E-3,  K3-4.39S-6 

RK  1  =  3. E-2 
=><2  =  3.  E-4 
R<3=L.E-6 
RETURN 
END 

S U9 R  OUT  l ME  IJSRIH 

COMMON/ SNOI  S/SO  visit  45  )  ,  SOWS  <  18  )  ,  SD  RF  0  U> 
CORMON/TCSYS/TAUSIf))  ,  DI  ST  (  A) 

NARELlST/l NS/TAUS *  D  I ST , SOWS U, SOWS, SDWFO 


PRINT*,"  " 
PRINT*,"  <( L) 
PRINT*,"  < ( 2  I 
PRINT*,"  < ( 3 ) 


EAST  LONGITUDE" 
NORTH  LATITUDE" 
ALTITUDE  (UP)" 


$ 


164 


» 


c 


PRINT* 

II 

X(  A) 

FAST  VELOCITY” 

V  R l NT* 

tl 

X(  5) 

NOR  TO  VELOCITY” 

PRINT* 

H 

X  (  6  ) 

V K R  T  I  C  A L  VELOC ITY"  ■ 

PRINT* 

11 

X  (  7  ) 

FAST  ATTITUDE  ” 

PRINT* 

l» 

X  (  0  ) 

NOP  T!  1  ATTITUDE  ” 

PRINT* 

If 

X  (  0) 

UP 

ATTITUDE  " 

P  X  I  H  T  * 

II 

X  (  1  o  ) 

X 

GYRO  Dry  I  FT  RATE  " 

PRINT* 

.  " 

X(ll) 

Y 

GYRO  OPIFT  RATE  " 

PRINT* 

II 

XI  1?  ) 

Z 

GYRO  DRIFT  RATE  " 

P  3 I  NT* 

»l 

X  (  13) 

X 

GYRO  SCALE  FACTOR  " 

PRINT* 

II 

X(  16) 

Y 

GYRO  SCALE  FACTOR  " 

P  R  I  N  T  * 

«1 

X(  15  ) 

Z 

GYRO  SCALE  FACTOR  ” 

P  3. 1  NT* 

II 

X  (  1  6  ) 

X 

GYRO  MISALIGN  A ‘TOUT 

Y 

1 

PR  I NT* 

ft 

X(  17) 

X 

GYRO  MISALIGN  A  f3  J  <  J  T 

Z 

f 

P  « 1ST* 

II 

X  (  l  3  ) 

Y 

GYRO  MISALIGN  ABBOT 

X 

t 

PRINT* 

II 

X(  in 

Y 

GYRO  MISALIGN  Aii'JlJT 

l 

1 

PR  I  NT* 

tl 

<(  20) 

Z 

GYRO  MISALIGN  A >3 3 U T 

X 

1 

P  p  I  N  T  * 

II 

X  (  21) 

Z 

GYRO  MISALIGN  A  HOOT 

Y 

1 

PRINT* 

II 

X(  22) 

X 

ACCEL  NONREPEAT  3  IAS 

ii 

PRINT* 

II 

X(  23  ) 

Y 

ACCEL  NONREPEAT  BIAS 

it 

PRINT* 

II 

X  (  2  4  ) 

Z 

ACCEL  NONREPEAT  BUS 

,t 

PRINT* 

If 

X(  25  ) 

X 

ACCEL  60  MIN  BIAS  " 

PRINT* 

II 

X{  26) 

Y 

ACCEL  60  MIN  BUS  ” 

PRINT* 

If 

X(  27) 

Z 

ACCEL  60  MIN  BIAS  " 

P  R  INT* 

It 

X(  28) 

X 

ACCEL  15  MIN  3 1  AS  ” 

PRINT* 

It 

XT  29) 

Y 

ACCEL  15  MIN  BIAS  " 

PRINT*,” 

XT  30) 

Z 

ACCEL  15  MIN  BIAS  " 

PRINT* 

If 

XT  31 ) 

X 

ACCEL  SCALE  FACTOR  ” 

PRINT* 

II 

XT  32) 

Y 

ACCEL  SCALE  FACTOR  " 

PRINT* 

tl 

XT  33) 

Z 

ACCEL  SCALE  FACTOR  ” 

P  R INT* 

II 

XT  34  ) 

X 

ACCEL  MISALIGN  ABOUT 

Y 

II 

PRINT* 

It 

XT  35  ) 

X 

ACCEL  MISALIGN  ABOUT 

Z 

If 

PRINT* 

It 

X  (  3  6  ) 

Y 

ACCEL  MISALIGN  ABOUT 

X 

?l 

PRINT* 

If 

X  (  3  7  ) 

Y 

ACCEL  MISALIGN  ABOUT 

Z 

If 

P  R  INT* 

ft 

XT  3.3  ) 

Z 

ACCEL  MISALIGN  ABOUT 

X 

II 

PRINT* 

ft 

XT  39) 

Z 

ACCEL  MISALIGN  ABOUT 

y 

ft 

PRINT* 

It 

XT  AO) 

HA 

R  PRES  " 

PRINT* 

It 

X  (  4  1 ) 

OAR  SCALE  FACTOR  ” 

PRINT* 

It 

X  {  '♦  2  ) 

EAST  DEFL  GRAVITY  " 

PRINT* 

If 

XT  A3) 

NOR  DEFL  GRAVITY  " 

PRINf* 

It 

X  (  A  4 ) 

GRAVITY  ANOMALY  ” 

PRINT* 

tl 

XT  45 ) 

VERTICAL  ACCEL  ERROR" 

?FAD{5, IMS) 

w-  [TE(6»10D)  TAUS*DIST,SDWSO,SnwS,SOWFO 
?  i  T'.NN 

100  F  OYM AT { " 1"5 { / ) T 1 0"F IL  TE  R  MODEL  OATA-fiASE  FROM 
A..NA  ME  LIST  IMS:  ” 

E//T15"TIME  CONSTANTS,  TA'JS  " 
c.f  T20,6Gl<».  7 

F.  /  /  T  1  •» "  C  0  R  ^  c  L  A  T  ION  DISTANCE,  DIST  " 
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F./T?0«4r.l4.7 
U  /  T  l‘."Sf)WS  1" 

F./7(/T20»fcGM.7>  /T20,3G14.7 

£//r  ivsdms" 

F.  /  It  /T  to  ,  sr,  l A .  7)  /  T  20 , 3G  l  4 . 7 
F.//TI  V’SORF  V’ 

f./  r?o,  igia.  t ) 

END 


SUBROUTINE  XFDOTtl RUN,T  *NF  «NS ,NXT J  »XF »XS  *XTR A J  »NTR » >  =  » XOOT ) 

c  □  m  n  o  n  /  r  r  j  c  n  m  /  *  e  » r.  *  o  *  e  r.  a  *  e  «  r  k  i  ♦  r  ;<  z  ,  a  k  3 

COMMON/SNUIS/SOWSTtAS) ,SOWS{ 1  a ) tSOMFOt 1) 

DIMENSION  XF(NF)  ,XOOT(NF)  »XS(NS)yXTRAJ(NXTJ)«PF(MTR) 

xonnu-o. 

RETURN 

ENTRY  XFDOTO 
XF{ 1) -0. 

RETURN 

END 


SU3 ROUTINE  XSOOTf IRUN » T »NF »NS » NXT J * XF ♦ XS » XTR A J « XDOT) 
DIMENSION  XF<NF)  «XS(NS)  »XTRA J(NXTJ) » XDOT (NS) 

C  OMMON I TC  S  Y  S / T  AUS ( 6 ) * D I S  T ( A ) 

COnNON/SNOI  S/SOWSOC  A5)  ,  SDWSi  18)  »SDWF0(1) 

COMMON/ TRJCON/RE,G,OKEG A »E»RKL»RX2*RK3 

C  1A  TRAJECTORY  INPUTS  FROM  PROFGEN 

SLAT  =  XTR  A J { I ) 

RLON-XTR A  J ( 2 ) 

A LPHA-XTRAJ (1) 

ALT-XTRAJ(^) 

R  0L-XTRAJ(5) 

PIT  =  XT  R  A  J  (  5  ) 

YAW-XTRAJI7) 

VN-XTRAJI  ’)) 

V  E -  —  XT  R  A  J  {  9  ) 

V  U  =  X  T  R  A  J  (  10  ) 

FN-XTRAJ(IL) 

FEa-XTRAJ(L?) 

FU*XTRAJ( 13  ) 

DR3L-XTRA J(  IA> 

OPIT3XTRAJ{ 15) 

OYAw=XTRAJ(  IM 


V  GMT  =  SORT!  ‘/N->*2  +VF.<=  *2  I 
SLAT«SIN(P.LAT) 
CLAT-COSI «?!  AT) 
TLAT-SLAT/"LAT 

HHEGAN-Ofir  GA^CLAT 
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0  MF  G  AU  ■=  0 ME  G  A •> S L  A T 
SX^S  I  M  (  ROL  ) 

CX«COS(ROL) 

SY=SIN<PIT) 

CY=COS(PIT) 

SZ«SINIYAWI 

C Z-COS (YA W) 

A  =  S I N ( AL?  H A ) 

'  C  A  =  CUS ( ALPHA ) 

SL9M?SlN(RLON) 

CL0N*C3S(3L0N) 

C  RHO  IS  THE  ANGJLAR  VELOCITY  OF  THE  WAV  FRAME  WRT  EARTH 

R  Hf)r.=-VN/RE 

RHON-VE/RE 

RHOU-VE*TLAT/R6 


C  WE-WN-WU  ARE  THE  ANGULAR  VELOCITY  OF  THE  NAV  FRAME  WRT 
C  INERTIAL  FRAME  COORD INAT I  ZED ■ IN  THE  NAV  FRAME  (E-N-U) 


WE=RHOE 

WN=RHON*OMEGAN 

WU-RHOUOMEGAU 

C  COMPONENTS  OF  THE  9X9  MATRIX 

RKZ=VU/RE 
9 LAT2»2.*RLAT 

F42=2.* (OMEGAN*VN*OMEGAU*VU) *RHON*7N/ (CLAT**? ) 

F'+3=RH0U*RH0S  +  RH0N*RKZ 

FAA=-RHOE*TLAT~RKZ 

F5  2  =  -2.*a.MSGAN*V&-RHON*VE/CLAT!!'*2 

F  5 3 =R HONOR  HOU-RHOE*R<Z 

F63  =  2.*G/RE-RHON<=*2-KHOE*<‘2 

F  92  =  WN*RH0J<‘TLAT 

C  TRANSFORMATION  FROM  NAV  FRAME  (E-N-U)  TO  300Y  FRAME  (X-f-Z) 

CXE=$Z*CY 

CXN=CZ*CY 

CXU*SY 

CYE  =  SZ*SY4>SX»-CZ1<'CX 
CYN  =  CZ<'SY*SX-SZ*CX 
r,YU»-CY*SX 
CZ£"-CZ<:SX*-SZ!!,SY<!CX 
CZ.N"CZ*SY*CX*SZ  +  SX 
CZU=-CY#CX 

<:  TRANSFORMATION  FROM  RQOY  FRAME  (X-Y-Z)  TO  NAV  FRAME  (E-N-U) 
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ce  x»cxf. 

(HY-CYE 
CEZ-CZE 
CNX"CXN 
CNY  =  CYN 
C  H  l »  C  Z  N 
CIJX-CXU 
CIJY-CYU 
cuz=czu 

C  SPECIFIC  FORCE  IN  THE  filllDY  FRAME 

F  X  =  CXN*FN*CXE*FE*-CXU*FU 
F  Y=CYN*F  N  +  CYF.frFE+CYU^U 
F  Z  =  C  Z  N  '•>  F  N  ♦  C  Z  E  *  r  E  •*■  C  Z  lJ  ^  F  U 

C  ANGULAR  VELOCITY  OF  ftOOY  FRAME  W  3.  T  INERTIAL  FRAME 
C  COOROINATIZEO  IN  THE  RUDY  FRAME 


W  X  *  C  X  E  *  M  E  ►  C  X  N  *  R  N  +  C  X  U  *  R  U  +  0  R  0  L 
WY  =  CYE*WE*CYN*WN  +  CYIRwiJ*OPIT 
WZaCZE^WE  +  CZNR'WN+CZU^WU  +  OYAW 


XOOT(l)*XS(2)*RHOU/CLAT-X$(3)*RHON/(RE*CLATH-XS(4)/ 

£(  RF.^CLAT) 

Xr>0TI2)=XS{  3)*RHOE/R  =  *XS(5)/RG 

X[)C1T<  3)  =-R<  L«XS  (3)  *XS  ( h  )+XS  I'tO)  *RK1*XS<  '♦!  )  «■  R <  1 5*  ALT 

XOOTI A) *X3 ( 2) *F42*XS ( 3) *F43*XS ( A) *=4*  +  XS ( 5 ) *  I W J  +  OMEGAU) 
E-XS (6)*( WN*ONEGANJ-XS( 6 ) *F J+XS ( 9 ) *FN 
£«-XS<22)  *CEX*XS(23)«'CEY*XS(24)*CEZ 
£  +  XS(25)*CEX  +  XS(26)!>CEY  +  XS(27)  *CEZ 
fit XS( 2S) *CEX+XS(29) *CEY  +  XS<  30)*CEZ 
£«-XS(3I)*CEX<‘FX  +  XS(3  2)A!CEY^rY  +  XS(3  3);5!CEZ*FZ 
£-XS( 3«)*CEX*FZ*XSI 35 ) *CEX*FY*X$ (3b)*CEY*FZ 
S-XS  (  37)<iCEY<,F!<-XS(39)vCEZ*FY^XS(3V)*CEZ*FX  +  XS  (  A  2  ) 

YOOT(5)  =  XS<  2)*F5  2  +  X<>(  3  )  *F  53-X  S  C  A  )  *  2  .  *  WJ-XS  (  5 )  *  R  K  Z 
£ ♦ XS ( 6 ) $  R  HO  E  +X  S ( 7 ) *  FU - X  S ( 9 ) *  F  E 
£tXS(22)<tCNXtX$(23)*CMY+XS(24)*CNZ 
£  «•  X S  (  2 5  )  * C N X  ♦  X 3  (  2 6  )  *C*IY*  XS  (  2  7  )  *CNZ 
£»XS(28)«CNXfXS( 29  )  *CN Y*X S ( 30)*CNZ 
£  ♦  X  S  <  3ll*CNX*FX«-XS(  32  )  *C NY*F  Y*  X5  {  3  3  )  *CNZ*F  Z 
£-X3(  3M  *CN<*FZ*XS(  35  )  *CNX*FY*XS<  36 )*CNY*FZ 
£-XS  (  37)*CNY->FX-X.S  (  33  )  *CNZ*FY+XS  (39)  4CN  Z*FX-*-XS  (  A3) 

XD.IT  (  h)  «-XS  t  ?  )*?  .  *Us1GGAIJ*VE  +  XS  (  3  K  (  Fb3-R<  2  )  *XS  (  A  )  ’’■'2  *  *  WN 
£  -  X  5  (  b )  *  2  .  *  k  H  0  F  -  X  S  (  7  )  *  F  N  ♦  X  S  (  «  )  *  F  F 
£♦ XS(22  )  *CUX+  XS  (  21)  COY*  XS  (  2 A  )*CUZ 
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xs ( P‘1 ) <•  c u x *•  x s  { ?(' »  *cuy*xs ( ?:t )  *cuz 
f.  ♦  xs  ( :m )  ±c,u  <  *■  <  >  ( <■'))  *cjy«  xs<  -jnj  *cu/ 
f.*xsni  J  *CJX*FX»XS(  l.> )  *CUY#PYfXS(  33)*i:U/*F7 
F.-XS  (  (4)  *CJX  >F  7  f  XS  (  Vj )  *r.UX*FY«-XS  (  \h)  >■  CUY  F  l 
f.-XS  (  37)  «'COY<!FX-XS{  3.3)  *C'J7*FY  +  XS  (  d  )  *CUZ#FX 
f.*  XS  (  40)  *R<?  »XS(  41  )  *«<  2*  ALT*XS  (  44  > 
f.  -  X  $  (  4 1> ) 


Xt)0T(7)«-XS(3  )*«HnE/»f:-XS  { *>  )  /  R  I:  +  XS  (  3  )  *  WU- X  S  (  9  )  <■  WN 
F.*XS(  10)  *CF.X  *XS{  lll*CEY^XSll?  )  +CEZ 
£♦  XS  (  13)  *C  =  X*WX*  <S(  14 )  *Ci-:Y*WY  +  X$(  15)  *CEZ*WZ 
£  +  XS(l6)‘)'CFX=!'^Z-XS(17)<'CFX'!‘WY-XS(13)i‘CrY«W2 
£  +  XS(L9)*C&Y<!|JX*XS(20)*CtiZ*WY-X$(21)*CHZ<:WX 

XUOT  (  3)  =-X$  {  2  IOMEGA  J-XS  (  3  )  *RHON/Sr  +  XS  ( <♦  )  /RE-XS  (7)  *«  J 
E  +  XSTm^b  +  XSl  1:>)*GMX*XS<  ll)*CNY  +  XS<  12)*CNZ 
K  *  XS  (  13  )  *r.SX*<X*-XS  {  1 4 )  #CNY*VY*XS  ( 1:>  )  #CNZ#WZ 
5*  XS  (  Lf> )  *CNX*w/-x$(  17  )  *01X**Y~X$  ( If)  )*CNY*WZ 
f.*  XS(  19  )  *CNYM:<*  XS  (20)  *CNZ*WY-XS  (  21)  *CNZ*WX 

XDOT  (7)  =  XS  (  2  )  *F  92-XS  (  3)  *RHOU/RE+XS  ( 4  )  *TLA T/R  =  ♦ X S  (  7  )HN 
F.-XS  (9)  *XE*XS  (  13) +CUX»XS  (  11)  *CUY  +  XS(  12  )*CUZ 
£  ♦  X  S  (  13)*CJX»WX  +  XS(  14)  *CJY*rfY*XS(  15)*CUZ*WZ 
£ ♦ X  S { 16)*CUX*VZ-XS(17)*CUX*WY-XS<18 )#CUY*WZ 
C ♦ XS  « 19)*CUY*rfX+XS(20)*CUZ*WY-XS(21)*CUZ»HX 

0  0  2  I  “  1 0  t  2^4 
2  XD0T(I)«0.f 

X00T(25)=-XS(25)/TAUS(1) 

XDOT { 26) — XS ( tb J/TAUS  (  2 ) 

X0QT(27)=-XS(27)/TAUS(3) 

X00T(23)»- XS(28)/TAUS(  A) 

X00T{29)--XS(29)/TAUS(5 ) 

X  DOT ( 30 ) *- X S ( 30 ) /T AUS ( 6  ) 

00  4  1*31,39 
4  XOOT ( I ) =0« 

XOQTl 4  0)— XS( 40)*VGN9/3  I  ST ( 1 > 

XOOT ( 41 ) =0 . 

xn0T(42)«-XS(42)*'/G’n/0IST(2) 

XBOT  C  43  >  — XS ( 43 ) *VGNO/ 0  I  ST  C  3  ) 

XOOT  (44  )  =  -X  S  (44  )*V5N3/.)IST(4  ) 

X0']T(4‘j)=XS<3)**K3-XS(4  0)<‘RK3-XS{41)4‘RK3*ALT 

P  CTO'-m 

entry  xsooro 

0  0  LO  I  3  1 »  4  *5 

io  xs(  I  )»r,Auss  (o.  ,snwsn(  I ) ) 


RETURN 

P  FMO 

TRUTH  MUOF  L  FOR  PREVIOUS  GENERATION  INERTIAL  R  K  F  SYSTEM 
JPROATA 

NF«l,  N  S  *  4  *>  ,  TF-1400.,  r>TPR'JT*lSO.  »  !)  TP  -'PL  =  15  .  ,  9IN3YS-15.  . 
LP*XF«.T.,  LPRLT-.F.,  LPRDG-.F.,  L  P  P  -  .  T  .  ,  NXT  J  »  ]  h ,  LX  T  J  *  .  T  .  , 
i«0,LPRXTJ».T.,_CC'».T..DTCCPL*3.  ,  I  PASS- SO  .4 


45*0. 

1*0. 

1.1.1. 

0.0.0. 


>INS  T  A  US  (1  )  =  3600.  ,  1600  .,  3 *>00  .  .  00  0.  ,9u0  .,900., 

0  mm  =  151  9025.0,60  761  .033  3, 6076  1.03  33 ,3ft  4566. 19, 


S0-*S0( l)a7.l63235-5» 
9.557655-3, 
.55-3, 
4.36332E-7, 
100.6-6, 
2.903835-5, 
2.90883E-5, 


7.165236-5 
9.557655-3 
.56-3 
4.363326-7 
100.6-6 
2. 903 -3  3  6-5 
2.903336-5 


1.5  6+3 

9.55765E-S 
.  56-3 
4. 36332E-7 
100.6-6 
2.903355-5 
2.90988E-5 


S0WS(1  )  = 


8.056-3, 

8.05E-3, 

8.056-3, 

1.233E-3 , 

1.2885-3, 

1.2836-3, 

6.44E-4, 

6.44E-4, 

6.44E-4, 

500.6-6, 

500. £-6, 

500.5-6, 

4 .848136-5  , 

4, 34 3135-5,  4 

. 343136-5, 

4.343136-5, 

4.84313E-5,  4 

.846135-5, 

5  .  E  *  2  , 

3.6-2, 

3.372E-4, 

5.474E-4, 

1. 127E-3 , 

1.5-2, 

2.25  E-2, 

3.71779E-6, 

3.717795-6, 

3 . 7 1 7  79E-6 

1.21243E-9, 

1.212435-9, 

1 • 2 1 2  4  3 E-9 

1.253  E -  3 , 

1.233  5-3, 

1.263  E-3 

6.44  6-4, 

6,44  5-4, 

6.44  E-4 

5 .  6+2, 

3.372  5-4, 

5.474  E-4 

1.127  E - 3 , 

1.5  E-i , 

S9WP0(  1 )  =  1.  .  ,t 
.01(86667 

1  ,0,0,34  17.7467 

2  ,0,0,3437.7467 
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1.0,0, 1  . 

A  ,  0 , 0 » l  , 

6, 0.0, 1. 

6,0,0, l  ■  y 

7,0,0,1417. 7467 
R, 0,0, 1437. 7467 
«,0,0, 3437,746 ? 

0 , 0 , 0 , 0  , 

T  I  (MIN) 

LONOI  TUOS  ERROR 
POSITION  *ARC  HII* 

LATITUDE  ERROR 
POSITION  ♦ARC  MI  v|* 

ALTITUDE  ERROR 
ALTITUDE  *FE[:T* 

EAST  VELOCITY  ERROR 
VELOCITY  *FP3* 

NORTH  VELOCITY  ERROR 

v=locity  *fps* 

UP  VELOCITY  ERROR 
VELOCITY  *FPS* 

EAST  TILT 
TILT  *ARC  MIN* 

NORTH  TILT 
TILT  *  A  R  C  MIN* 

AZIMUTH  ERROR 
A ZM  *  A  R  C  MIN* 


A  P  P  f  N  0 1  X  r, 


S 1 1  h H:  SU'IR  JUT  !  NTS  FOR  FILTER  MODEL 

SUP  ROUT  IMF  An>:'Nn(IRUN,T,NF,NS*NXTJ,XF»XS,XTRAJ) 
n  1  -i!  'MS  ION  XF  (  Mr-  )  ,:<S(  MS  )  ,  XTRAJ  (  HXT  J  ) 

S  E  TURN 

ENTRY  AMENOU 

S  E  TURN 

EMU 


SUBROUTINE  ESTIXI  IRON,  T  , NF , N S , NXT J , XF , XS , X TR A J  , NTR,P -  ) 
DIMENSION  XF (NF  )  ,X$< MS )  ,  X  T  R  A  J ( NX! J) ♦  P  F  (  M  T  R  ) 

RETURN 

ENTRY  CSTIXO 

RETURN 

ENO 

SUBROUTINE  FQGcMI I  RUN , T »NF,NS»NXTJ»XF»XS,XTRAJ, 
*NZF,MZQ,F,DF) 

0  I? -ENSIGN  XFINF ) ,XS( NS ) ,  XTRA J(NXTJ) ,F(NZF) ,QF{ NZO) 

COMMON /TCSYS/TAUF IS) ,0IST<4) 

CGMMON/FNOI  S/SDWFO(45  )  ,QFIN(  16)  tSDWSOM.) 

C  OM MON/  TR  J C  0.1/  R fc  , G  ,f)MEG  A  ,  E  ,  RK 1  ,  R K2 >  RK  3 
COi-MON/Cl/CXE  ,CXN,CXJ,CYE  ,  CYN  ,  C YU  ,  C Z E  ,  C ZN  ,  C Z J 
C0NM0N/C2/CEX,CEY,CEZ,CNX,CNY,CNZ,CUX,CUY,CJZ 
COMMON/C4/SLAT, CLAY, TLA  T, SX,CX,SY, CY,SZ ,CZ,S A, CA, SLON  ,CL3N 
COMM.0N/C5 /RL  A  T,PLON,  ALPHA,  ALT,  ROLL,  PITCH,  YAW,  VN,V£,VJ 
CPMMQN/C6/VGN0, QMEGAN-OMEGAU.RHOE, RHON,RHOU,RKZ 
C0MM0N/C7/WE  » WN  ♦  ;<fU  ,  WX,  wY,WZ 
C0'MCN/CS/F42,F4  3,F44  ,F52,F53,F63,F92 
C0*H0N/C9/FX,FY  ,FZ,FN,FE,FU 

F (1) =RHQU/CLAT 
F  m»-RH'W/(RE*CLAT) 

F (3)=l./(RE*CLAT) 

F  <  <*  )  =  9.  HOE  /R  g 
F (7)*F42 
F(P)=F43 
F  (  9  >  *  F  4  A 
F ( lOl-OMEGAU+WU 
c ( 1 1 ) =-OMEG  AN-WN 
F(I?)--FU 
F  C  13J-FN 
F  (  14  )*CFX 
F (  15  J-CEY 
F  (  l  *, )  «CE  Z 
F  <  L  7 ) «C EX 
F  (1  -  C  E  Y 

F (  10 ) -CcZ 
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F  (?0)-Ct'X 
V { ?  i  )-CFY 
F  (22  )  “CL- Z 
F  J?J)»CrX*FX 
F  (  M  )  =  C  4  Y  ■«*  F  Y 

F  (  ?  *>  >  »C*:  /  ^  I-  / 

F  (26)  a  -  C  F  X  *  F  Z 
F|?7)«CEX*FY 
F ( 2 3 ) »CFY*  :  Z 
F  <  20  )«-CFY*FX 
F  (  3  0  )  *  -  C Z  <*  F  Y 
F  (  31  ) -CC’Z  fr?  X 
F  133>=F52 
F  (  1 4  )  *  F  6  3 
F(.3'j)S!”2«i!,'XU 
F  <  36) =  -**Z 
F  (  37) 

F  (  3  H  )  =  F II 
F ( ?0)=-FE 
F  (*»0) -CNX 
F ( 4  L ) =CNY 
F (4?)=CNZ 
F  (43)=C.MX 
F(44)=CNY 
F  ( A5J-CMZ 
F  (  46)=CNX 
F (47)-CNY 
F  (  43 ) =CNZ 
F  (49)»CNX*FX 
F ( 50)=CNY*FY 
F(51)»CHZ*FZ 
F (5? I--CNX0FZ 
F ( 53 )-CMX*sY 
F(54)=CNY*CZ 
F  <  55 ) =-CNY *FX 
F  (56)--CNZ*FY 
F ( 57)-CMZ*FX 
F(50)»-2.  +  3*<eGAli*YE 
F  ( 69>«F63-*K2 
F  C6L)-2.*MS 
F (62)*-2.*?H3E 
F ( 64 ) =  -FN 
F  (  6  5 )  =  F  c 
F l 66 ) =CUX 
F 1 47) -CUY 
F  <4‘5)=CUZ 
F { 67) *CUX 
F  (  70)  *C»JY 
F (71 ) -CU7 
F  (  7  ?  )  =  C  !J  X 
F ( 73 ) -GUY 
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r  1 1>\ )  *cuz 
f  ( z *>  )«i:‘j/*r  x 
f  ( /m»cuy*fy 
r-(  7?j*cu/*  =  z 
F  (7HI— cux*fz 
f  ( 7  > )  =::ux«  =  y 
f  ( ao )  *=  r.tj y# f  z 
F  (  a  l  )»-C'JY*FX 
F  (*<!)— CU/*FY 
F ( rt 1)  »CUZ*FX 
F(rff>)=}K2*ALT 

F { a Z) — RH3E/RG 
F  {  »•■>)  =  ail 
F  (  ‘JO  )  »-W N 

F (91) -  CSX 
F(92)»CEY 
F  f  9 !) )  -  C  F  z 
F  {  94  )  *C.:iX*4X 
F (95 J =  CEY*-<Y 
c  (96)=CEZ*«IZ 
F (97J-CEX*WZ 
F ( 9a  J =  -CEX*  WY 
r  (99)— C6Y*HZ 
F { 100) -CEYfWX 
F ( 101) =CEZ*WY 
F { 102 ) =-CEZ*WX 
F  (  103)— OMEGAU 
F ( 104 ) — RH3N/RE 
F ( 104) — WU 
F ( 107) «WE 
F (10a)«CNX 
F { 109) -CNY 
F(110)-CNZ 
F(111)-CMX*WX 
F ( 112)«CNY*9Y 
F (  1 13) -CNZ*WZ 
F  (  114)  -CNXMZ 
F  (115)  =-CMX4W y 

F (  116) — CMY*WZ 
F  (  1  L7)*CpIY*WX 
F ( US) »CNZ*VY 
F  (  1  l/J)*— CNZ*rfX 
F(  120)-F92 
f  (  121) =-Snou/R£ 

F  (  1?? ) =TLA  T/*G 
r  (  12  3)  =  W  .9 
F (124) — Wt 

F ( 125) -CUX 
F  (  120)  »CIJY 
F ( 12  n  =cuz 
F ( l?a ) -CUX4WX 
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F  1129}  -CUY-MY 
r  f  130) -Cl)/ *9/ 

F(Lin-CUX4>HZ 
F  {  132  )— CimuY 
F  (l  33)  «-CUY  M/ 

F-m'i)  =»CUY*WX 
F ( l  V>)=CUZ*WY 
F  {  l  3b)  =  -CU/  *A'< 

F(l37)»-l./TAUFCl) 

F  (  13.?)— 1./TAUFC2) 

F<139)=-l./TAUF(3) 

F ( 1  AO) 3-1. /TAUF <  4  ) 

F { 141) s-l./TAUF (5) 

F  (142)=  — ).  »/TAUF{6) 

F (  14  3) =  —  V  G  M  0  /  0 1 ST  (  1) 
c  (  144)  =  -VSN>)/9IST(2) 

F  (  1  45) =-VG4D/0I ST ( 3) 

F  (  LA-',)  =  -VGN  0/9 1 S  T (  4) 

F  (  150)  =RKl*ALr 
F  {  152)=-RK3*ALT 

00  5  I  -  1 3  « 16 
5  0  F  (  I )  =  9  F  I N  (  I ) GND 

RETURN 

ENTRY  FQGSNO 
0  0  10  1=1,1?. 

10  QF(t)»QFIM(I» 

F ( 5 ) =1. /RE 
F  (  b  )  =  1 . 

F  <  3  2  )  =  1  • 

F  (  58 ) *  1  • 

F <63)=»-i. 

F (34)=RK? 

F(»6)-L. 

F(R3)«-1./RE 
F ( 105) -l./ RE 
F { 147) =RK3 
F  (  14  3)  — JUL 
F ( 14  9) =  R  K  1 
F ( 15 1) =-RK3 
RETURN 
END 

SUBROUTINE  HRZ(  I  RUN, T , NF , NS , NXT J, XF , XS, XTR A J ,NT R , PF , I  ME  AS , 
**,H,R,ZRES) 

01. PENSION  XF(NF  )  , X  S ( N  S )  ,H(NF) ,XTRAJ ( NXT J ) ,PF(NTR) 

R E  TURN 
ENTRY  HRZO 
RETURN 
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S UPROOT  IV-  SM!lYS(  I  =■'  J  T  .Ml  ,  N  S  ,  N  <  T  J  .  X  F  ,  XS  ,  X  T  R  A  J  ) 
CfHMON/FNiJI  S  /  S  0  W  H  CM  4  S  >  ,OF  IN(  16)  ,SOWS<)(  i) 

COMMON/  TCSYS/T AUF  I S) ,01 S  T( 4) 

0  I  HF  NS  I  ON  XF<  NF )  ,XS( NS  )  ,XTRAJ(NXTJ) 

ENTRY  SMOYSf) 

R  ETURN 

r-No 

SUBROUTINE  T R  A J (  I  RUN , T  ,  N F  ,  MS  ,  NXT  J  ,  XT-  ,  XS  ,  XT  R  A  J  ) 

COHMON/TRJCO*</RF*r,,'MEGA  , E » ? K 1 , RK Z  ,  R K 3 
H  I  ME  MS  I  ON  XF:<NF  )  ,XS(NS)  , X TR A J < NXT J ) 

0  1  M  E  S  S  1  0  M  TITLE  {20) 

.DIMENSION  SEGLNK  SO)  ,  R  F  S  T  R  T  (  :>  0 )  ,  I  T  U  R  N  (6  0  )  ,  M  P  M  -I  (  6  0  )  *  ? 
0 I  MENS  ION  T  ACC ( 60) ,HEAD<  SO ) . F I T( DO )  ,07  01 60) .MODE ( 60 ) 
DIMENSION  ERR  0 R (SO) , HMA X ( 50 ) ,HM1N(50) 
o.  ETURN 
ENTRY  TRAJD 

READ  (3)  TITLE*TnOAY*CLQCK 

READ  (3)  I  PROA  ♦NSVJTiLLMECH*  TSTART,  VTD .  PHE  ADO,  ?  I  TO, 

£  ALFA0,LAT3  ,LONG,ALTO,I  PRNT,  J.RITE  «  I  PLOT  »  PO-RAT  «  LUNI  T 
R  E  AO  (3)  SEGLNT,KESTRT, ITURN,NPATH»PACC,TACC,HEAD» 

£  PIT,DT0».M3DE,S«R0R,H>tAX,HMIN 
IF  CIRUN.GT.l)  GO  TO  10 

CALL  PAG  COS {44* l) 

WRITE  (6,100)  TITLE, TODAY, CLOCK 
100  FORHAK  1X,7HTITLE:  ,  ZO  A  4  / 1 X  ,  7  HO  A  T  E  :  ,  A 10  /  1 X  ,  7  M  T I  M  E  : 


PRIST*,” 
PRIST*,” 
PRIST*,” 
PRIST*," 
PRINT*," 
PRIST*  ,” 
PRIST*," 
PRIST*," 
PRIST*," 
PRIST*," 
PRIST*," 
PRIST*," 
P  R 1ST*  ,  ” 
PRINT*,” 
P  R I  ST*  ,  ” 
PRIST*,” 
PRIST*," 
PRIST*," 
PRIST*,” 
P  R  1ST*," 
PRINT*," 


IPRO-35  "  ,  I  P  R  0  3 
NS  EG  T:  ",NSEGT 
L-MECH: "  ,LLMSCH 
TSTART TSTART 
VTO:  ",VTO 

PSE AOO : n,PHEAOO 
P  ITCH!)  :",PITO 
A  _  F  A  0  :  "  ,  A  L  F  A  0 
IPRNT:  ",IPRNT 
I  RITE:  "  ,  I R I T  E 
TPLOT:  " ,  I  PLOT 
ROLRAT : w*ROLRAT 
LJNIT:  ",LUSIT 

If 

SEGLMT : " , SE  GLM  T 
RESTRT  :",RE5TRT 
I  TURN:  ",ITURN 
SPATH:  ",NPATH 
PACC:  "  «P ACC 

T  A  C  C :  ",TACC 

HEAD:  ",HKAO 


:  C  (  5  3  ) 


,  A10) 


176 


P  R  I  N  T  *  i  " 

i*  i  reus 

".PIT 

p  i i  [  ,.|  f  )  ,  " 

010  .• 

",un 

PRINT**" 

MODI  : 

” ,  MODE 

PRINT*," 

ERROR: 

", ERROR 

PRINT*,” 

UMAX: 

",1IMAX 

PRINTS*" 

HR  IN: 

»  ,HM  IN 

10  CUflTlN'Jfc 

at-?092'jb^3. 
r,  *  N  2  .  0  8  H  1 5  1  6 

r -1./29H.3 

ST  A  N  0  A  R  0  <  VALUES  ARE  Kl=3.E-2»  <2  =  3.f:-4,  K3- 
OPTIMAL  <  VALUES  ARE  K1-I.O03,  X2-4.17E-3,  *3 


RX l=3.5-2 
R  X  2  =  3 .  e  -  * 

3.  <3  =  1.5 -6  > 

R  E  TURN 

END 


SUBROUTINE  USRIN 

common/fnois/sowfoi^5)  » or- i m i  lb)  ,sowso(i) 

CO«rtrjN/TCSTS/TAUFI6»*OIST<J) 

NAMcLIST/HF/TAUF»OIST*SOWFO»QFIN»SDWSO 


PRINT-*" 

If 

PRINT**” 

X(  1  ) 

PRINT**" 

X(  2) 

PRINT**" 

X  <  3  ) 

PRINT*," 

X  t  A ) 

PRINT**" 

X(  5  ) 

PRINT**" 

Xt  6) 

PRINT**" 

X(  7  ) 

PRINT**" 

X<  8) 

P  R I  NT*  * " 

X(  0  ) 

PRINT*, " 

X(  10  ) 

PRINT**" 

X(  11) 

PRINT**" 

X(  1Z  ) 

PRINT*.” 

Xt  L3) 

PRINT * , " 

X(  1*) 

PRINT**" 

X(  18) 

PRINT*.” 

X<  16) 

PRINT**” 

X{  17  ) 

PRINT**" 

X  (  1  fl  ) 

p  y  l  ti  T  *  *  " 

X  {  10  > 

P  P  [  N  T  *  t "  X  (  Z  0  ) 
p  P  I  M  T  *  *  "  <  (  2  l ) 
P  R  I M  T  *  *  "  X  (  Z  2  ) 


EAST  LONGITUDE” 

NORTH  LATITUDE11 
ALTITUDE  (UP)" 

EAST  velocity” 

NORTH  VELOCITY” 

VERTICAL  VELOCITY" 
east  ATTITUDE  " 

NORTH  ATTITUDE 

up  attitude 
X  GYRO  DRIFT  RATE  " 

Y  GYRO  DRIFT  RATE  ” 

Z  GYRO  DRIFT  RATE  " 

X  GYRO  SCALE  FACTOR  " 

Y  GYRO  SCALE  FACTOR  ” 

L  GYRO  SCALE  FACTOR  " 

X  GYRO  MISALIGN  A  3  0  U T  Y 

X  GYRO  MISALIGN  A«DUT  Z 

Y  G  Y  R 0  M I S A  L I G N  A  B  JUT  X 

Y  GYRO  MISALIGN  ABOUT  Z 

Z  GYRO  MISALIGN  ABOUT  X 

I  GYRO  MISALIGN  ABOUT  Y 

X  ACCEL  NON? EP EAT  BIAS  " 


PRINT* 

II 

X<  21) 

Y 

ACCEL 

N  0  N  t  F  P  F  A  T  BIAS 

If 

PR ! NT* 

II 

X  (  2  4  ) 

7 

ACCEL 

HON  RIP  l-AT  BIAS 

It 

PRINT* 

tl 

X  (  2  5  ) 

X 

ACCEL 

6 0  MIN  BIAS  " 

PRINT* 

II 

X  (  ?  6  ) 

Y 

ACCEL 

GO  HIM  BIAS  " 

PRINT* 

H 

XI  27) 

7 

ACCEL 

60  MIN  BIAS  " 

P  R  I  N  T  * 

II 

X  (  2  H  ) 

X 

ACCEL 

15  MIN  BIAS  ” 

PRINT* 

II 

X<  2(M 

Y 

ACCEL 

15  MIN  BIAS  " 

PRINT* 

II 

X<  30) 

7. 

ACCEL 

15  MIN  BIAS  " 

PRINT* 

II 

X(  31) 

X 

ACCEL 

SCALE  FACTOR  " 

PRINT* 

1? 

X{  3?  ) 

Y 

ACCEL 

SCALE  FACTOR  " 

PRINT* 

It 

X(  33) 

7. 

ACCEL 

SCALE  FACTOR  " 

PRINT* 

fl 

X<  34) 

X 

ACCEL 

MISALIGN  ABOUT 

Y 

II 

P  » INT* 

II 

XI  35) 

X 

ACCEL 

MISALIGN  ABOUT 

1 

T» 

PRINTS 

If 

XI  3  6) 

Y 

ACCEL 

MISALIGN  ABOUT 

X 

l| 

PRINT* 

II 

X  (  5  7) 

Y 

ACCEL 

MISALIGN  ABOUT 

7. 

II 

PR  INT* 

tl 

XI  33) 

7 

ACCEL 

MISALIGN  ABOUT 

X 

tl 

PRINT* 

II 

X  (  3  9  ) 

l 

ACCEL 

MISALIGN  ABOUT 

Y 

If 

PR  INT* 

It 

X(  NO) 

BAR  PRE 

S  " 

PRINT* 

11 

X  (41) 

BAR  SC  A 

LE  FACTOR  " 

PRINT* 

M 

X  (  4  2  ) 

EAST  OS 

FL  GRAVITY  " 

PRINT* 

11 

X  (  4  3  ) 

NO  R  OE  FL  GRAVITY  " 

P  SINT* 

M 

X(  44) 

GRAVITY 

ANOMALY  " 

PRINT* 

M 

X(  45) 

VE 

STICAL  ACCEL  ERROR" 

9EA0(5,INF) 

MRITE(6»1DD)  TAUF,OIST, SQWFO, QFIN, SDWSO 
RETURN 

100  FORMAT  (  11 1"  5  (  /  )  TLO" FILTFR  MODEL  DATA-BASE  FROM 
ENAMELIST  IMF:  '» 

E//T15'1  TIME  CONST  AMTS  ,  TAUF  ’• 

S/T20,6G14.7 

£  / /T15M  CORRELATION  DISTANCE,  DIST  " 

£/T20,4Gl4.7 
£  /  /  T  1 5  "  S  D  *i  F  3  " 

£/?(  /T20,6514.7)/T20,3G14.7 
£//TL5"QF  IN" 

£/3( /T20,5G14,7) /T20,3G14.7 
£  /  /  T  1  5  M  S  0  *  S  3  " 

£  /  T  2  0  ,  G 1  4 . 7  ) 

ENO 

SUBROUTINE  XSD3TC IRUN,T ,NF,NS ,NXT J ,XF ,XS ,XTR4 J, XDOT ) 
Cn*H()N/TRJCO.M/RE  ,G,OMEGA,c,RKl  ,P.K2  ,RX3 
C  DM Mnu/  FNO  t  S  /SO  WFU  (  4  4  >  ,  OF  I  N  (  1. 6  )  ,  S  D WS 0  ( l ) 

DIMENSION  XF(NF  )  » X  DO  T  IMF)  ,XS(NS),XTP.  AJ(MXTJ) 
y DOT ( 1 ) -0. 

RETURN 

FNTsY  XSDOTO 

x  s  m  »  o . 

RETURN 
F  MD 
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S  U3R  r  1 1  i  T  I  Mr  '.<F  )0  T  (  I  RUN  ,  T  %  MF  »  W  5  »  NX  T  J  »  <F  »  XS  ,  X  J  ■>.  A  J  *  NTR  »?’  *  ♦  XDQT  ) 
DIMENSION  X  F  (  N  F  )  »X  S ( NS  )  «X  TR  A  J  t  NXT  J  )  » XDOT (  NS  )  »  P  F  (  NT*  ) 

CO'-NflN/TCSr  S/  TAUF  (  h)  *  i>  I  ST  (  A  ) 

C  OMnON/FNO  I  S  /S')  WI  P  (  Vi  )  *  QF  I  M{  1.  f> )  »  SO  WS,)  (  I ) 

C  l)  r  M ! )  N  /  T  R  J  C  0  "  /  R  f.  ,  G  ♦  D  M  L'  0  A  « f.  »  R  K  1 1  R  K  2  »  X  K  3 
C  n  v  M :  I  '■!  /  C 1  /  f.  X  »CXN,CXU»CYi-»CYN,CYU»C/fc,CZN»CZ’J 
COMMON/ C2/CEX ,CEY»CE l . C NX , CNY . C NZ .COX. COY tCiJZ 
C  0  »  M ! )  N  /  C  4  /  S 1.  A  r  ,  C  L  A  T  t  T  L  A  T  ,  S  X  ,  C  X  ♦  S  Y ,  C  Y  »  S  7  *  C  /  «  S  A  ,  C  A  ,  S  L  H  N  ,  C  L  t )  N 
CU*M0N/C5  /  *  LAT  >  PL  ON  »  ALP  HA  ,  ALT  » ROLL  .  P  1  TCH ,  V A  W ,  V N  ,  V El  i  V  J 
C  ON  WON/ Cb / V  G  N  0 «  0 REGAN »  0  MG G  AO » ft HOF * P  HON j  K HOU i R K Z 
C  OMMON/C7/-E ♦  >M  » WU*  WX« WY»WZ 
C  0  H  M  0  N  /  C  8  /  h  4  2  *  F  A  3  ,  F  4  A  »  F  “5  2 »  F  5  3  «  F  6  3  »  r  9  2. 

C  l)  i*1  M  t  J  N  /  C ')  /  r  X » F  Y  *  E  Z  »  F  N  i  F  t  i  F  U 

C  l  />  TRAJECTORY  INPUTS  l:  R  0  1  P  R  0  F  G  E  N 

RLAT*XTRAJ(  l) 

R  L  0  N  =  X  T  R  A  J  (  2  ) 

ALPHA=XTRAJ ( 3 ) 

ALT~XTRAJ( 4  ) 

R0LL»XTRAJ(5) 

P ITCH=XTRAJ (6) 

Y  A  W  =  X  T  R  A  J  (  7  ) 

VN-XTRA J< 3) 

VE=  —  XTRAJI9) 

V IJ  =  X  T  R  A  J  (  13  ) 

FN=XTRAJ(  11  ) 

FE--XTPAJ< 12) 

FIJ  =  XTRAJ(  13  > 

0  ROLL-XTRAJ ( 14) 

D  P I TCH  =  XTP  A  J ( 15) 

DYAW  =  XTR A J(  15  > 

V  G  N  0  =  S  0  R  T  (  V  N  -  *  2  +  V  E  *  *  2  ) 

SLAT-SIN(RLAT) 

CLAT-C'JS(R-AT) 

TLAT=SLAT/CLAT 

0 MEGAN*OME3 A*CL AT 
0  Mr.  G  AU  =  ONES  A*  SL  AT 
3  X  =  S  I  N  (  R  0  L  L  ) 

CX  =  C'JS(  POLL  ) 

S  Y  ~  S I N ( PITCH) 

C Y  =  COS <  P I TCH ) 

S  /  =  S  I N  {  Y  A  W  ) 

C  Z  =  03S ( YAW ) 

S  A  =  S INC  ALPHA  ) 

CARGOS ( ALPHA  ) 

S  L  0  M  -  5  I  N  ( 5  L  ON ) 

CLOH-COSt  R_UN> 
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C  SMH  IS  THE  AMG.JLAR  VC  LOG  I  TY  DP  I  HP  NAV  F  R  A  N  E  WRT  FART  H 

PHOI:=-VN/RE 
R  H I )  N  =  V  F  /  R  F 
VHr)U*VG*rL\T/Rt 

C  WF-WN-'.'U  ARE  THE  ANGULAR  VELOCITY  OF  T H !-  WAV  FRAME  WRT 
C  INERT  I  A  L  FRAMF  CUORO I  NAT  I Z E D  IN  THE  NAY  FRAME  (E-N-U) 

w  F  =  RMOE 

«'  N  =  RHON ♦  0  ME  G  AN 

wu=rhoj*omegau 

C  COMPONENTS  OF  THE  9  X  9  MATRIX 

RKZ-VU/RE 
P  L  A  T  2  =  2  .  *  R  .  A  T 

F  A  2  =  2  «  ^  (  0  AF  GAN*  VN+OMGGAUSVU  )  ♦HHON*  VN/  {  CL  A  T  *  -2  ) 

F  A3«RH0U*»HI)l-*-RH0N*R'<Z 
F  AA=-RHGE*TLAT-R!<Z 
F  5  2=-2  . *3MGGAN*VE-RH0N*VE/CLAT**2 
F  5  3  =  R  HON  *  R  H  QU-P  HOE  *R  <  Z 
F  (>  3  =  2  .  $  G  /  R  E  -  R  HO  N  *  *  2  -  R  H  0  E  *  #  2 
c  9  2  =  W  N ♦ k  H  QU  $  T  LA  T 

C  TRANSFORMATION  FROM  NAV  FRAME  (E-N-U )  TO  BODY  FRAME  (X-Y-Z) 

CXE=SZ*CY 
CXM-CZ*CY 
C  XU  =  S  Y 

CYE=SZ*SY*SX+CZ*CX 

CYN=CZ*SY*5X-SZ*CX 

CYU=-CY*SX 

CZE^-CZ^SX+SZ^SY^CX 

c  zn=cz*sy*:x  +  sz*sx 

CZU=-CY*CX 

C  TRANSFORMATION  FROM  BODY  FRAME  (X-Y-Z)  TO  NAV  FRAME  (E-N-U) 

CEX-CXE 
C  E  Y  -  C  Y'C 
C  F.  Z  =  C  Z  6 
CNX-CXN 
C  N  Y  =  C  Y  N 
r,  N  Z  -  c  Z  N 
CUX^CXU 
C  U  Y  =  C  Y  U 
CUZ=CZU 

C  SPECIFIC  FORCE  IN  THE  BOGY  FRAME 
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r  x^cxm*  r-N  ►  ■: xi  ■> f t:  ♦nxu*FU 

r-  Y  -  (',  Y  M  v  i  li  i  C.  Y  F  *  F  I  t ;;  y  d  <•  F  U 

f  z = c  z  m  ■>  r  n  ♦  r.  z  t:  *  f  i:  ♦  c  /  u  •>  f  ij 

c  .wguia*  v«  l  •  u;  i  r  y  n<-  f;  ■.?  ny  fyamf  w-'T  initial  fsa'IE 
C  CnfRL)  IMAT  1 1  FG  Id  Mi;  -(ODY  Fi-'AMR 


WX=CXE*  9E  +  C  XN’H9  +  CXU*WU*OPOLL 
WY^CYfc-Mc  +  r.  YN*9MCYL)*WU  +  0P  ITCH 
WZ»CZt*.'C  *C  ZM*WN  +  CZU*WUH3YAW 


X  DHT  (  l )  =  XF  (  2  )  v 2 H 0 1 J / C L  A T  —  X F  (  3  )  *<iH0N/  I  K !•  *CL  A  T  )  *  XF  (  4  )  / 
5 ( PE* Cl AT) 

X!)dT  (  2  )  =XF  (  3  )  ** HDF/9F  +  XF  (  ft  )  /  RE 

X  OPT  (  3  )  =  -P  <  l*XK  {  3  )  f  XF  (ft  )  +XF  (  ^ 0  )  **:<  L  »-XI-  (  4L  >  ALT 


X  DOT  (  4)  =  XF  (  2  }  *F42* W  (  ))  *F  4  3  ♦  X  F  (  4  )  *c  4  4  +  X«=  (  ft  )  *  (  H  ‘J  +  OMEG  A  U  ) 
r.  -  xf  (  6  )  *  (  Wd  ♦  O-l r. r,  A  a.  )  -X  F  (  8  )  *  F  J  ♦  X  F  (  9  )  *  F M 
£*XF(2  2)*CEX*XF123)*CEY«-XF(24)*CEZ 
E*XF ( 2b ) *CsX  fXF( 2fe) *CCY*XF(27) *CEZ 
F.*XF{28)*CEX  +  XF(29)*CcY*-XF(30)«CEZ 
f.  +  XF(3l)  *CEX*FX«-XF(321*C£Y*FY«-XF(33)  *CEZ*FZ 
F.-XF(  34 )*CEX*FZ*XF<  35  1  *Cf=X*FY  +  XF  (  3ft  >  *CEY*FZ 
e-XH (371 *CEY*FX-XF< 38)*CEZ*FY*XF ( 39 ) *CEZ*FX+XF( 42 > 

XDGT(5)=XF(2)*F52  +  XF(3) *F 53-XF < 4 ) *2  .  *WU-XF ( 5 > *KK Z 
E  +  XF  (  ft  )  4  H  "1  5  ♦  X  F  (  7  H-FIJ-XF  (  9)  *FE 
E*XF ( 22 )  *CNX*XF<  2  3  )  *CN  Y*  XF  (  2  4  )  *CNZ 
6  •*■  X  F  (  25  )  4 C M X XF  (  2ft)  *C  N  Y  •*•  X  F  (  27  )  *  C  N  Z 
E*XF ( 23 ) *CNX  +  Xr ( 29  )  *CNY*XF{ 30) *CNZ 
E  +  XF  (  31  )*CNX*FX+XF<  32  )#CNY<,FY*XF(33)*CNZ*FZ 
S-XF (  34 ) *CMX*FZ  +  XF( 3ft )*CdX*FY  +  XF  <  3ft ) *CNYYFZ 
E-XF ( 37) *CNY*FX-XF ( 30  >  *CNZ*FY  +  XF( 39 ) *CNZ*FX  +  XF<  43 ) 

XDOT  (6)  *-XF  (  2  )4  2  .*n*EGAU*VE*XF  (  3  )  ’M  F ft 3-3 K 2  )  +  X?  <  4  )  #2.  *WN 
E-XF(5)*2.*<H0E-XF(7)*FN+XF(8)*FE 
E*XF<  22)*CJ<*XF(23)*C1JY  +  XF(Z4>+CUZ 
£  ♦  XF  {  25  )  *CUX*XF  {  2b  )  *CU  Y*  XF  (  27  )  *C'J  Z 
E  ♦  XF  (  ZH  )  *C!JX*XF  (  2  ft)  *CUY  +  XF  (  30  )  *CUZ 
£*XF  <  31 ) *CJX*FX  +  XF( 32) *CUY*FY  +  XF( 33) *CUZ*FZ 
E-XF ( 34 ) *CJX*FZ  +XF ( 3ft ) ^CUX^FY  +  XF ( 3ft ) *CUY*F  Z 
E-XF  (  37)  *CJ Y*FX-XF(  3ft)  *CUZ*FY+XF  (39  )  *CUZ*FX 
F.  ♦XF  (  40)  +  *'K2  +  XF  (  41)  K2  4  ALT  +  XF-  (  44  ) 

E -  X  F (4ft) 

X  f) 0 T  (  7  )  ~ - X P  (  3  )  «9v|rj'-/9F  -  XF  (  ft  )  /  RF:  +  XF  (  ft  }  4WIJ-XF  (  9  )  <*  Wd 
E  +  XF  (  10  )  *CF  X  t-XF  (  1  1  )  *GEY  X  F  (  1 2  )  *  C  E:  / 

E  +  XF  I  L  3)  *r.F  X-MX+XF  (  14  )  <  .  /4WY+XF  (  1  ft  )  *CV:/*W 
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•*  *>v  •» 


E*XF  (  lt>)  *CFX*WZ-X!  (  17  )  *C  F- X*  *  Y-XF  (  1 3)  •< C l  Y <■  W  / 

F  ♦  X  F  (  l  9  )  •>  0 !  Y  <•  W  X  ♦  X  F  (  2  0 )  *  C  E  Z  <•  R  Y  -  X  F-  (  2  1  )  *CC  l  '■>  X 

X  DOT  ( H) =- <" (2)  ‘■‘'OR-GAU-X  F:  (  3  )  ■>  R  HON  /  R  *  <  F  ( 4  )  /R  F. -X -  {  7  )  *  H  J 
f.  ♦  X  F  (  0)  ♦  Wl:*XF  (  LO)  *!'.NX*XF  (  U  )  <=CNY*Xl;  (  12  )  *CN/ 

f. ♦  x f  mi  >i:mx*wx*xf  {  14 )  *r.:mwY*xF  ( 1  -3 )  *ckz*w/ 

F  ♦  X  F  (  1  b  )  v  c  NX  *  w  /  -  x  r  (  1/)  V  c  h|  X  v  w Y -X  F  (  1(0  *  "  M  Y  X  w  / 

F  +  XF ( 19 )  <«CNY*WX*  <F  (  ?0)  *CNZ  *h‘Y-XF  (  21  )  »C^/-»WX 


X0l)T(9)  =  <F  (  ?.  )*F9?-XF  (  3)  *RHOU/RE*XF  ( 4  )  $TL AT/RE*  XF  <  7  )  -MN 
F  -  X  F  (  M)  *  ,*)  t :  ♦  X  F  (  LO)  +CUX«-Xr  (  11  )*r.UY*XF  (  L  2  )*CUZ 

F  v  X  F  (13)  *CJX*  ■)  X  ►  X.  F  (  )  *CUY* JY*XF  (  15  )*0UZ*MZ 

S  ♦XF  (  lh  )  XCUX** Z-XF  <  17  )  *CUX*WY-XF  (  L>,  >  *CUY*WZ 
5  ♦  X  F  (  19  J  <=  C  J Y * W  X ♦  X F  (  20  )  *C U  7  *  ■> Y-XF  (  21  >  :<CU7.*WX 


OD  2  1=10,24 
2  XDOTm-O. 

X  0  0  T  (  2  5  >  =  -  X  F  (  2  5  )  /  T  A  U  F  (  l  ) 

X  0 1 )  T  (  2  h  )  »  -  <  F  (  2.  n  )  /  T  A  U  F  (  2  ) 

XDUT(2  7)  =  -XF(2.7)/TAUFn) 

X  0  0  T  (  2  3  )  =  -  X  F  (  23  )  /TAUF  (4  ) 

XOOTl 29 ) «  — X  F (20 ) /TAUF ( 5 ) 

X  0  0  T  (  30  )  =-XF(  30  )  /TAUF  {  ?,  ) 

00  4  1=31,39 
4  XD0T(I)«*0. 

XOUT(  4  0  )  =-XF I  40  >*VGNO/DIST ( 1 ) 

XD3T< 41 ) =0. 

XO'OT  (  42  )  --XP  (  42  )  *VGND/D  I  ST  (  2  ) 
XDQT<43)=-XF(43)*VGND/0IST(3) 

XOOT  (  4  4  )  --XF  (  4  4  )  *VGNI)/0  IST(  4) 

X00T(45)=XF(3)*RK3-XF(40)*RK3-XF<4l)*RK3*ALT 
R  F;  T  U  R  M 

FNTRY  XFDOTO 
RETURN 
E  NO 

THR F;F  AXIS  RLG  FILTER  MODEL 
A  D  R  0  AT  A 

N  S  =  1  ,  T  F  =  1400  .  ,  0TPRPL’L5.,  NXTJ=U>,  LPP  =  .T., 

NZC»152,  N70»l'),  LPRXS  =  .F.  ,  LPRXF=.T.,  LPRLT---.F.,  LaRDG  =  .T., 
L  XT  J  ~ . T . ,  DTPRMT=159.  ,3  =  0,  LPRXTJ=.T., 


L  C  C  -  •  T 

. , OTCCPL 

=  3 

«  i  s 

l  ,  2  , 

L,  3, 

1  , 

4, 

2,  3, 

2,  5, 

1  ,  h  » 

4  ,  2  , 

4  , 

3, 

4  ,  4  , 

4  ,  3  , 

4  ,  , 

4,  3, 

4  , 

9, 

4,22, 

4,23, 

4,24, 

4,23, 

4  , 

2  6  , 

4,27, 

4 ,24, 

4 ,29, 

4  ,  30  , 

4  , 

31  , 

4,32, 

4 , 3  3 , 
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4,34, 

4,35, 

4  ,  3  4, 

4  ,  3  7  , 

4  ,  3  3  , 

4,39, 

4 ,42, 

> ,  7  , 

5,  3, 

4  ,  4 , 

4,  5  , 

9 ,  6 , 

4 ,  7, 

4,  9, 

4,22, 

5,73, 

4,24, 

6 ,25, 

5,26, 

4,27, 

4,34, 

4 , 2  9  , 

5,30, 

4,31, 

5,3?, 

4,7  1, 

4,  <4, 

4  ,  .3  4  , 

5  »  3 1>  , 

5,37, 

4  ,  3  3  , 

4  ,  3  9  , 

4,41, 

6,  2  , 

6,  3, 

5  ,  4  , 

6  ,  5  , 

6,45, 

6,  7, 

6,  8  , 

6.77, 

6,23, 

6»24, 

6,25, 

6,26, 

6,37, 

6,28, 

6,29, 

6,30, 

6,31 , 

6,32, 

6,33, 

6,34* 

6 ,35, 

6,36, 

6,37, 

6,38, 

6,39* 

6,40  , 

6,41, 

6,44, 

7,  3, 

7,  4  , 

7,  8, 

7,  9, 

7,10, 

7,11, 

7,12, 

7,13, 

7,14, 

7.15, 

7  , 1  o  , 

7,17, 

7,13, 

7,19, 

7,20, 

7,21, 

H,  2, 

8,  3, 

8,  4, 

4,  7, 

8  ,  9, 

8,10, 

3,11, 

8 ,12, 

4,13, 

8  ,14, 

8,15, 

>3 ,  L  6  , 

3,17, 

3 ,  n , 

8  ,  1 9  , 

3 ,20, 

8 , 21  ♦ 

9,  2, 

9,  3, 

9,  4, 

9 ,  7 , 

9,  3, 

9,10, 

9,11, 

9,12  , 

9  ,13, 

9,14, 

9,15, 

9,14, 

9,17, 

9,  13, 

9,19, 

9,20, 

9,21, 

2  5,25  , 

2  6,26, 

2  7,27, 

2  3,28, 

29,29, 

30 ,30, 

40, 40, 

42,42, 

4  3,43  , 

44,44, 

45,  3, 

3,  3, 

3,40, 

3,41, 

45,40, 

4  5,41 

7,  7 

,  3,3 

,  9,9 

,  10,10 

11,11, 

12,12, 

25,25  , 

26,26, 

2  7,27, 

24,25, 

29,29  , 

30,30, 

40,40, 

42,42, 

43,43, 

4  4,44, 

1*0. 


45*0 . 


1 1 If  5. 1 3835E-9 
?  ,2,  5.  1  30  35F.-9 
3,3,2.256*6 
4 , 4 i9. 134566-15 
5,5,9. 1  3  4  0  6  E  - 1 5 
4  ,  6  ,  9 .  13  4  3  6  E  - 1 5 
7,7, . 25 E-6 
< ,  * , . 25E-6 
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Appendix  H 


Plots  of  ensemble  averages  of  error 
states,  plus  and  minus  one  standard 
deviation,  as  a  result  of  specific 
sensor  errors. 
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Figure  H -•  1 .  Longitude  error  state  from  accelerometer  noise 


Figure  ti-sl.  Latitude  error  state  from  acceloromo ter  noise 
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Figure  H-5.  Altitude  error  state  from  accelerometer  noise 
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Figure  H-10 
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Figure  11-12.  East  vel,  error  state  from  gyro  noise 
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Figure  1 : — J. 3' •  North  vel,  error  state  from  gyro  noise 
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ERROR  +  AND  -  SIGMfl,  50  RUNS,  COHORT,  ONLY  XC11)-X(221 


Figure  H-14.  Altitude  error  state  from  gyro  noise 


ERROR  +  RND  -  SISMR,  50  RUNS,  COMBAT,  ONLY  XC1D-XC221 


'iguro  ii-l 


U[>  vel.  error  state  Irom  gyro  not 


raiit-W  ERH 


r igurci  il-19 •  iiast  vol.  error  state  from  r. yro  bias 


ERROR  +  RND  -  SIGMfl,  50  RUNS,  COMBAT,  ONLY  X ( 1 1) -X  C 13) 


'W/Vv 


x~\ 


“\ — r\A>""'  '"V 


_ r*\ 

-  V  ' 


300.0  103.0  530.0  030  0 

nnc  (r>r:c) 


ilox’th  vel.  error  state  from 


ERROR  +  FIND  -  SIGMA,  50  RUNS,  CO-MBRT,  ONuY  X ( 14)  -X ( 1 6) 


figure  H-21.  East  tilt  error  state  from  gyro  scale  factor 
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ERROR  +  AND  -  SIGMA,  50  RUNS,  COMBAT,  ONLY  X  C17) -X  C22I 
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Figure  H-24.  East  vel.  error  state  from  gyro  misalignment 
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ERROR  +  AND  -  SIGMA,  50  RUNS,  COMBAT,  ONLY  X  C17)  -X  C221 


-26.  East  tilt  error  state  from  gyro  misalignment 
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Figure  H- 28 .  Azimuth  error  state  from  rjro  misalignment 
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Figure  li-29*  East  tilt  error  state  from  gyro  white  noise 
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Figure  H-32.  Fast  tilt  error  state  l'i  '  ;n  gyro  S.F.  nonlinearity 


ERROR  +  AND  -  SIGMA,  50  RUNS,  COMBAT,  ONLY  SPNL 


C 

O  j' 

o'  o  ..  -'ll 


0.0  100.0  200. 0  300  0  100.0  500.0  r,00. 0  700.0  I'OO.O  000.0  1000  0 

T!ME  (SEC) 


i-  igur< 


Porta  tilt,  i-'rror 


non  I  moarity 


ERROR  +  FIND  -  SIGMA,  50  RUNS,  COMBAT,  X ( 1 1 ) “X ( 57) -0 

o 

1 


°  / 

!»'/ 


0  100.0  100.0  300.0  400.0  600.0  800.0  700.3  000.0  900.0  1000.0 

TIME  (SEC) 


Figure  H-35*  Altitude  error  state  from  gravity  error  sources 
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